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ABSTRACT 

This study examines the possibility of modeling and control of 
flexible manipulator arms. A modal approach Is used throughout the work 
for obtaining the mathematical model and control techniques applied. The 
arm model Is represented mathematically by a state space description de- 
fined In terms of joint angles and mode amplitudes obtained from trunc- 
ation on the distributed systems, and Includes the motion of a two link 
two joint arm. 

The problem of controlling the system Is examined via the linearized 
model and using a regulator type of control. Three basic techniques are 
used for this purpose: pole allocation with gains obtained from the rigid 
system with Interjoint feedbacks, SImon-MItter algorithm for pole allo- 
cation and sensitivity analysis with respect to parameter variations. 

An improvement In arm bandwidth Is obtained that could replace more con- 
servative designs currently In use. 

Optimization of some geometric parameters Is undertaken in order to 
maximize bandwidth for various payload sizes and programmed tasks. 

The controlled system Is examined under constant gains and using the 
nonlinear model for simulations following a time varying state trajectory. 
The procedure presented In this work Is general and can be Implemented to 
be used 1n more specific designs. 
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CHAPTLP I 
INTRODUCTIOM 


1.1 Scope of the Work 

Many recent studies deal with the design and control of mechanical 
manipulators that perform tasks similar to those of human arms. The 
possibility of using small computers located in the vicinity of the mani- 
pulator originated the so-called supervisory controlled devices, es- 
-ecially important when the distance between the arm and the operator 
introduces a tine lag in the information process [fl23, [Tl]. l!ov/ever, 
the arm dimensions or the velocity of performing a task can increase the 
effects of nonlinear factors that will complicate oven more the control 
process. Such control procedures v/ould require nonlinear techniques that 
may not be at hand. In the case of flexible mechanical arms, the vib- 
rations originated by the elasticity of the links would affect the ef- 
fectiveness of the system and even cause instability. In the interest 
of reducing these vibrations, this study deals v/ith the control of the 
nonlinear system with results obtained from the linear control theory. 

** suitable mathematical model is developed to represent the plane motion 
of two flexible beams by considering the rigid and flexiMp motions. The 
hypothesis of controlling the dynamic motion of the nonlinear model is 
examined by means of modal control applied to the linearized model. 

1.2 The System Hathematical Description 

The approacii assumed in this work is to derive the equations of 
motion of a system of two flexible beams pinned at one end and at the 
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joint. Lagrange's equation applied to a distributed system are used 
for this purpose. Basically the model is obtained by superposing the 
flexible motion over ^ hypothetical rigid body motion. For the purpose 
of this study, the elastic motion of tiie beams is truncated in the second 
mode and a six degree of freedon, nonlinear model is obtained. A good 
approximation for the dynamic shapes of the beams during the motion is 
achieved by using the appropriate boundary conditions. Some experimental 
results have shown good approximations for the values of natural frequen- 
cies of the uncontrolled system when compared with those obtained from 
tJie linearized mathematical model. Details of these procedures can be 
found in Chapter II. 

1 .3 Control from the Perspective of ‘lanipulator Design 

The basic idea for controlling the system Is to find the forces of 
torques that must be exerted on the manipulator joints In order to move 
the system from its present configuration to the desired position. If 
fast motions have to be performed, the dynamic forces will become signi- 
ficant and a reasonable control must be achieved for the nonlinear sys- 
tem. On the other hand, slow motion with large payload might give rise 
to undesired large deflections of the links. 

A broad analysis of manipulatoi design would depend upon geometric 
and elastic parameters, according to the tasks to be performed. In 
this work one considers the implications of applying modal control tech- 
niques to either short and rigid manipulators such as automation devices 
or long and flexible ones like the space shuttle boom. In both cases. 
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the control performance would depend upon physically available measure- 
ments. However, only a limited number of these quantities might be ob- 
tained for a given arm configuration. Tills suggests the comparison of 
control performance for cases where all of the variables could supposed- 
ly be measured and those when only some of them are vallable. Three 
different techniques are used In the present work resulting in a linear 
regulator type of control. The first technique viorks with the gains 
obtained In the allocation of poles In the rigid equivalent system and 
uses those gains in the control of the flexible model. The convenience 
of this method Is accentuated by the fact tliat simple measurements are 
sufficient for controlling the system. The second procedure is the use 
of Simon-Mitter algorithm [SI], [S2] for Independent positioning of poles. 
This procedure requires the measurement and/or estimation of some state 
variables that might require very sophisticated ins>. "lents. Finally, 
the third netiiod makes use of the poles sensitivites vn’th respect to 
parameters variations In order to find the elements of the feedback law. 
These procedures are described in Chapter III and a comparison of results 
is presented in Chapter IV. Estimates of maximum arm bandwidth are pre- 
sented for the case of controlling the flexible system vnth a control law 
obtained from the rigid model. 

Some simulations of the nonlinear system using the rigid control 
law and Simon-'litter algoritlim are presented in Chapter V for analyzing 
the system performance in tracking a time varying state trajectory. 
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1.4 Ramri cs 

The study of controlling flexible manipulators was first under- 
taken by Mirro [M2] in whidi a single .bean is analyzed from the point of 
view of optimal regulator theory. Before that, Tox^nsend [T1], Kahn [Kl] 
and many others were concerned with controlling essentially rigid mani- 
pulator arms. The most recent *.^rk on flexible systems is presented 
by Book [B2] and Uhitney, Book, Lynch .[W2] where the pertinent litera- 
ture can be found. 
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CHAPTER II 
SYSTEM DESCRIPTION 

2.1 The Physical Model 

The schematic of tlie general physical system Is shourn In Figure 2 . 1 . 
The system Is composed of two flexible bodies connected by a friction- 
less pinned joint. One end of the system Is attached to the origin of 
a reference frame. The system Is assumed to have planar motion and the 
relative motion of the two bodies results from torques applied at each 
joint of the system. In order to facilitate the description, the joints 
are nunnbered by 1 and 2 and tiie bodies will be represented by two flex- 
ible beams. At the end of beam 1, a concentrated mass representing the 
servo-motor at joint 2 and tne joint Itself; at the end of beam 2 , a 
discrete mass can also appear, representing a payload to be moved be- 
tween two points In the plane. 

In order to describe the motions, three reference frames can be 
defined: 

[0,X,Y] - an inertial reference frame with origin at joint 1 

[ 0 ,X|y^J_ g reference frame witn origin at 0 and the axis 
x^ tangent to beam 1 at point 0 

[ 02 tX 2 »y 2 ] ■ a reference frame with origin at joint 2 and with 
axis X2 tangent to beam 2 at point U2 

Also two angles can be defined: 

6 ](t) Is the angle between the axes X] and X 

62 (t) Is tne angle between the axes x^ and X 2 
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If noM a new system Is defined as being formed by two segments 00.| 
and 0^03, having the angle 62 at O^t the overall motion can be understood 
as a motion of a hypothetical rigid system 00^03 and a flexible motion 
of the beams 1 and 2 with respect to this moving system. In order to 
simplify the notations a matrix representation form of the reference 
frames can be introduced. 

Let 


{U} « 



be the unit vector of reference frame OXY 


(Ui) 




the unit vector of reference frame Ox^y^, 


the unit vector of reference frame 


then 


{U-|} - [Cl] {U> 


( 2 . 1 . 1 ) 


“ [C2] {U} 


( 2 . 1 . 2 ) 


[C^] and [C2] are the rotational-transformation matrices. (Reference [C2]). 
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Figure 2.1 

Schematic of the General Physical System 
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Then 


_ fc0i S01 ' 

{U,} - {U) 

-S6l C6i 


C(ei + 82 ) 5(01+62)1 _ 

{Up} « {U} 

|_-S(0i 62) C(01+ 02 j 


(2.1.3) 

(2.1.4) 



(2.1.5) 


fc(0l + 02 ) S(0i + 02 ) 

[Cp] ■ (2.1.6) 

|-s( 0 i + 82) c( 0 i + 02) 


where 


C01 ■ cos 01 

(2.1.7) 

S0J « sin 01 

(2.1.8) 

c(0i + 02 ) “ COS(0i + 02) 

(2.1.9) 


s(ei + 62) “ sin(ei + 02) 


(2.1.10) 
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2.2 Kinematic UescHptlon 

The position of any point In the system can be described by a con- 
venient definition of a set of coordinates. As Indicated In Figure 2.2> 
any point can be specified If a new variable u^(x^.t) Is defined as 
being the coordinate of the flexible motion witn respect to the refer- 
ence frame [O^x^y^]. The vector position of point would be 




*1 

^1 




( 2 . 2 ) 


2.2.1 Beam 1 

The vector position of any point In beam 1 Is 





* 1 ' 


H 

“1 


l“ij 




+ (x^se^ + u^ce^)!?^ 


(2.3) 


2.2.2 Seam 2 

In order to define the vector position of any point on beam 2, It 
will be necessary to assume that the displacements of the flexible bod- 
ies with respect to reference frames [Ox^y^] and [ 02 X 2 y 2 ] be small 
enough to consider the paths of points O 2 and 0^ as straight lines nor- 
mal to the respective reference frames. Then, as shown In Figure 2.3. 
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Vector Position of one Element in Beam 2 
Figure 2.3 
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“d2 ■ * ^^2 


If noM 


(2.4) 


> flexible linear displacement at end of be'' 


* length of beam 1 


Ig “ length of beam 2 


then 


00, = {U}^ J ' 

lisei 




(2.5.1) 


O^Og - {U}^ 


-UieS0i 

UieC6i 


-UieS 6 ^u^+ “lEceiUy 


(2.5.2) 


O2P2' • 




^4 »{U}^[C ]t 1^" 

n I In 


1°) 


>= X2c(e-| +e2)iTjj +X2 s(e^ +02)XT 


( 2 . 5 . 3 ) 


> - {Ul^CC^]^ I 


1.. 


2S(0^ + 02)iTj^ + c(0^ + 02)ir 

( 2 . 5 ./!) 
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and 



( 1 . 6 . 1 ) 


^ d 2 " *“ 1 E ®®1 * ® 2 ^ ‘ “ 2®^®1 ■*■ ® 2 ^^* 

+ [l]se^ + u^£ce^ + x2s(6i + 02 ) + U2c(ei + 02^^^ (2.6.2) 

The respective velocities are 

^dl * r.-®ix^se] -u^s02-0iuice^]u^+[e^x^ce^ + u-jCO^-u^e^se-iJu^ 

( 2 . 7 ) 

0 

^d2 * “ “1E^®1 " “lE®!*^®! " ■*■ °z' 

-ii2s(0i + 0^) - 02 ( 0 ^ + ©2)c(0^ + 02)]u^ Hl0lC01 + u^E^®l ‘ 

‘^ lE ®!^®! * 2^®1 * ® 2^^^®1 '*’ ® 2 ^ '*’ <^ 2 *^^®! * ® 2 ^ " ^ 2(®1 ■*■ ® 2 ^ 

(2.e) 


S(01 + 02)]Uy 
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where the dot neans tne derivative with respect to time. 

For any mass m. concentrated at joint 2 the velocity will be the 
same as for the end of beau 1 and for any patyload, the velocity will be 
the one at the end of beam 2. 


2.3 Kinetic Energy 

The kinetic energy of beams 1 and 2 can be expressed as 


Tfa = * ^2 * V2 




**d2**^d2*^ 


(2.9) 


where dn is the element of mass at point P^(i - 1,2) and m^ and m 2 
are the masses of beams 1 and 2 respectively. 

If now (2.7) and (2.8) are substituted into (2.9) the result is: 


Tjj = 1/28^^ x^^dir, ♦ 1/2 “i*!***" 

m^ m^ 

^/^^1 ^ u^^dm + 1/2n^l'j^6'j^ + 1/2uj2U^£^ + 1/2m2U^^^01^ + **^1^®1^1E 

j 

mi 

+1/2(8^ + 02)2 fx 2 ^- f 1/2 J U 2 ^dm+ 1/2(8^ j \x^ dm 
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+ (0^ + e^) I X2U2tto> + / ’^2**'" * 

^ 1 ® 1^®2 r ^ 2 *^ ^ ^ 1E^®1 * ® 2^*'®2 X * 2 **"' * u 

J ^2 * f^2 ^2 

^2 ’^^2 
l^e^(6^ + 92 )s(-02) J U2<lm + u^£0^(e^ + G 2 ) cb ^ J u 


,dm 


X2dm + 


dm ♦ 


u^£0lSO2 J U2<lm (2.10) 

•^m2 

The same procedure can be applied to a mass concentrated at joint 
2 and to a payload with moment of inertia with respect to an axis 
normal to the plane of motion and through the center of gravity. In 
fact, for the mass at joint 2 expression (2.7) can be modified to 


- UiEeise^] Uy (2j]) 
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and from expression (2.8) 

^ * [-l^eise^-uiEsei-u^g6lcei-l2(0i + 62)5(61 + 62 )-u 2 es( 6 i ♦ 62) 

-U 2 e( 6 i ♦ 62)0(61 + 62)]u^[ll0icei + UiEC 6 i-Uig 0 lS 0 i + 12(01 + ©2) 

c(©i + © 2 ) + i»2E^^®l * ®2^ ~“2E^®1 (2.12.1) 


v/here 

and U 2 £ ©re flexible displacement and velocity of the end of 
beam 2. If the moment of Inertia of the payload with respect to an axis 
through point Is defined by Jp and the angular displacement 


3U2 1 


ax. 


'2E 


( 2 . 12 . 2 ) 


Is taken into account* the total kinetic energy of the system can be 
finally expressed as: 



R^ldm 


+ 1/2 




•f 


T - 1/2 
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+ 





(2.13) 


2.4 Potential Energy 

The potential energy of the system will be assumed as composed of 
the energy associated to the rigid motion plus the elastic potential 
energy of the links. Then, assuming Ox as the reference position, the 
first approximation of the total potential of the system is (assuming 
and sufficiently small) 


V * m^g y (l-c0^) + mjgl^(l-ce^) + m2g[l^(l-c0i) 


^(l-c(e^ + 62))] + n^g[l,(l-c0,) + l2(l-c{0i + 02))J 

. .. . o ^2 

I A 


1/2 [ uJ 3 u,\ dx - 1/2 f El, 

Jo —I ■ 


■“2 


i ’’‘2^/ 


dx 


(2.14) 


where 
i .e. , 


g is the component of gravity acceleration in the Ox direction. 
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6 » 



(2.15) 


El^, EI 2 are stiffnesses of links 1 and ? respectively, assumed constant 
for the purpose of this model. 

2.5 Equations of Motion 

In order to write the equations of motion of the proposed system, it 
is possible to make use of the so called assume-modes method [Ml]. 

Based upon this method, a solution of the flexible motions could be as* 
sumed as being composed of a linear combination of admissible functions 
multiplied by time-dependent generalized coordinates. Here, by admiss- 
ible functions is meant any arbitrary function satisfying all the geo- 
metric or essential boundary conditions [Cl]. Then, in case of the flex- 
ible displacements of beams 1 and 2, it is possible to assume 

n 

u^ « (2.16.1) 

n 

“2 ' (2.16.2) 

where the admissible functions ^j^(x) must satisfy the geometric bound- 
ary conditions with respect to the representation of the links in the 
reference frames [O^Xiy-j] and [02X2y23* 

It is clear that the system is now represented by a (2n + 2) de- 
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grees of freedom system where [®^{t)» 82 (t)] and [q^^.(t), q 2 ^(t), i®l, 

. . .,n] are the generalized coordinates. >' 1 oreover, assuming that 
the amplitude of the higher inodes of the flexible links is very small 
compared with the first one» the system can be truncated with n equal 
2 , resulting in a 6 -degree of freedom problem. 

The (2.16) assumes the form 

“l * (2.17.1) 

“2 “ ♦21^*2)‘112^^) ♦22(*2^‘*22^^^ (2.17.2) 

if now* fij(i>j ' 1 * 2 ) are assumed to be the eigenfunctions of a 
clamped'free beam* tne geometnc boundary conditions will be satisfied 
and because the orthogonality of these functions 

0 ( = s) 

1 (r* s) (2.18) 


•ll 

0 


♦^(x)*j(x)dx 




(X)* ''(s)dx 


where 


♦ (x) * (cosh^.x - cosx x) - 0 (sinhx X - sinX^x) (2.19) 

p I I I I • 

as in reference [81], where r is the mode of vibrations and ^^.* 0 ^. are 
given by Table 2 . 1 . 
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r 

X \ 
r 

o 

r 

1 

1.875 

0.7340 

2 

4.694 

1.0184 


Table 2.1 Qiaracteristic Values for Clamped-free Beam 

Now the integrals in equations (2.10) and (2.14) can be evaluated. 

/ x-j^dm “ Jq (2.18.1) 

mi 

/ ii,2dm » / 2(ta, + / 2jj„, * q^^2/ ^^^2^^ + 

m^ ' W] ' ' ' 1 m^ nVj 

qi22/4i2^«lm “ "’l(^11^ ^12^J (2.18.2) 



^ ( 4 ^ 1^11 ^ 12^1 * ^ 11 ^ 

in^ *■ m-j 


^12 ^ * 12 ^**" “ ^11 * q ^2 

mi 


(2.18.3) 


where 
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p 

/ dn - neglected in the model 
mi 

/ X2^dm * Jqi 
m2 

f ii2^din - m2(c|2i2 + t|22^) 
m2 

/ U2^dm s neglected in the model 
m2 

/ X2U2dm = nw21q2i + nw22q22 
m2 

where 


nw21 = f ♦21*2'*"’ ° ^ 
m 2 0 

^2 

nw22 = / «(>22X2dm = / U2^'*’22(’^^^’< 
"»2 0 


f Xgdm * m2 
m 2 2 


(2.18.4) 

(2.18.5) 

(2.18.6) 

(2.18.7) 

(2.18.8) 

(2.18.9) 

(2.18.10) 


(2.18.11) 
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/ U2dm = / («21^21 * ♦22^22^**" * ^21 ^ ♦21*' * ^22 ■'’♦ 22 *" 

^ Hig 


nq2l + nq22 q22 


(2.18.12) 


wnere 


nq21 -f ♦2]dro * 
*"2 


^2 


(2.18.13) 


>2 

nq22 = / 4»22‘1''' * ^ 

m., 0 


(2.13.14) 


/ U2dm = f (♦21*121 * ♦22*122^'^"' ' ^^21 ^ ^22 (2.18.15) 

"’2 


nio ( 1^2 


For the potential energy, assuming El constant for each beam and 
neglecting tne effect of shear forces one can write 


^1 

/ EL 


' 32 u 


1 


dx^2 


^1 2 
dx • El, / (♦;, q,, + *"2 q,2> dx 


kwlllq^^2 + kwl22 q-|2^ 


(2.19) 


wiiere the generalized springs are 
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kwlll = El, / (♦ ")dx 
' 0 11 11 


kwl22 * El, / ")dx 

1 0 1? 

1 2 

/ E I„ ^ dx = kw211 q 2 i^ '^'^222 


3 2 
X2 


where 


kw211 * t I 2 / (♦2l"*2l"^‘** 
^2 

kw222 = E I 2 ^ 


( 2 . 20 . 1 ) 

( 2 . 20 . 2 ) 

( 2 . 21 ) 

( 2 . 22 . 1 ) 

(2.22.2) 


The total kinetic energy can then be written as 
T = 1/2 (Jq + mjl^^)02^ + l/2m^(q^^^ + q^^^) + l/2nij(e^^£q^ + 

®12b^l2^ ^ ^11E^12E ^ 11 ^ 12 ^ 02 [nwll + + (nwl2 + 

mjli*i2E)qi2^ ^ l/2(m2 + "ip)\^202^ + l/2(m2 + nip)(^iif:q^^ + ♦i2E^12'^ 
+ l/2(ni2 + mp)02^ ('^llE'ln ^ ♦l2E‘ll2^^ * ^"’2 * '"p)Xi02 (♦he^II * 
^12E*^12^ ■*■ l/2(doi *lp^(®2 * l/2in2(q21^ ■*■ ^22^^ * 
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* <®2 * * 3 ) * "\)'2*21E>’21 * 

(tiw22 + + ("12 + 2"\,)_11L *2(*2 + ^)‘°3 * 

2 

^l®2‘^®3t(V21E * + ^V22E * * ^^llE^ll * 

I 2 

*12E^12^^®2 *^®3 * ^♦llE^ll ■*■ ♦12E^12 ^^^"‘p*21E 

2 

+ nq2l)q2l '*’ ^**'p^22E ^ ^^22)q22^^®3 ” ^^llE^l] ^12E^]2^ 

(02 + ^)[(fnp*2iE * f*^21)q2^ + ^V22E ^ '’<l22)q22]se3 + 

(m 2 + 2iJ^)(^ii£q^^ + ♦i2e‘1i 2)®2^®2 + ^)®®j— (♦ he'^H ^ 

2 

♦^2E‘^^2^®2tV2lE * "^21)q2i + (V22E + nq22)q22Jse3 - 
^lV®2 * ®3)t(V21E^”‘’^^^‘^^^^^V22E * nq22)q22]se3 + 

^♦llE^^n ^ ♦i 2E‘’12^®2^®2 ^ ®3)t^V21E ^ "'»21)q2i + (mp«22E ^ 
nq 22 )q 22 ]c 03 + ^/2Jp(^2iE**l21 ^ ^22E^22^^ 

For the potential energy 

h h 

V “ {(m^ + 2nij + 2nip + 2m2)— (1 - C0^) + (m 2 + 2mp)~ 


(2.23) 
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[1 " c(e^ + ^11^ ■*■ *^wl22 + kw211 + 

kw222 q22^ + k (2.24) 

Where: 

k is the reference potential energy for the flexible components 
^11E* ^12L deflections of beam 1 

^1E> ^22E deflections of beam 2 

*21E'» *22e' angles at end of beam 2 

g is the acceleration of gravity in X direction 

If now 01 , 02 , qn, qi2» ^21* *122 assumed to be a set of generalized 
coordinates and t] and are nonconservative torques acting at the joints 
of the system, it is possible to write the equations of motion using 
Lagrange's equations for a nonconservati ve system. These equations have 
tne form 

il + 3V “ Q- r=l,?...6 (2.25) 

ItUq^) aq^ aq^ 

where are time- dependent nonconservative generalized forces (or 
torques). In this particular case, the torques and are going to 
realize work only for variations of 0^ and ag. Then, if a variation 50 ^ 
occurs at joint 1, with all other variables kept constant, the virtual 
work done is: 
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6W » fi, (?.26) 

and 

(2.27) 

Similarly 

Q 2 “ \ (2.28) 

Also, from the definition of the angle given at the beginning of 
this chapter it is possib'e to show that the remaining generalized 
forces are equal to zero. 

Then, the equations of motion become 


•• •• •» 
Hn0i + Ml 009 + Mtjq. 


- 1I8II - FI + ( 2 . 29 . 1 ) 

'* 21®1 '* 22®2 ^ ■‘ 23^11 *^ 24^*12 ^^25921 ^26922 “ 

- MB12 - F2 + Tg (2.29.2) 


H310I + M 3202 + M33q'n + M34qi2 + M35q21 + M3g’q22 “ 
- KWlll - F3 


(2.29.3) 
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^41®1 * ^43^11 ^ ^44^12 * ^45921 ♦ ^46^22 = 

-KWl22qi2-F4 (2.29.4) 

Hsi’e] +• M52O2 + M539II + ^54(1*12 + M 55 q 2 l + M 56 q 22 " 

-KW211 q2i - F5 (2.29.5> 

MelQi + M62&2 ■» ‘''639 r. + M64Q12 + ^>65^21 ■*■ ^’66922 ' 

-KW222 q22 - F6 (2.29.6) 


where the coefficients are given by 

p 2 

Mn • (Jq ■*■ '"jl-r) ('"2 (**12 *12E912^ 

(Joi + Jp) i^Z +2mp)lil2C02 + 2{!f2 + Z'n^){ + **'12E'*1C' 

I 2 

2 562 - 2(mp21 q2i + mp22 q22)liS02 + 2(4^ ^^q^^ + ♦i 2 e 912) 

(mp21 q 2 i + np22 q22)c®2 (2.30.1) 

Mi 2 + (Joi * * ^"’2 + 2mp)-^ C02 + (ti^ + 2rH))(^^^gqn + 

'*'12Eqi2)s®2 ■ (j"P21q2i + mp22 q22)llS02 ^ ('”P21 921 ■*■ "’P^2 q22) 
(<M1E911 <M2E912)‘^®2 (2.30.2) 

^2 

Mi 3 = (nwll + nijli^iiE) + (m 2 + mp)!!^!^^ ^'”2 '*’2'%) *HE T" 

- (mp21 q 2 i + mp22 q22)^lE*®2 (2.30.3) 
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Mi4 • («*12 ♦ ii^ll4|2E) ♦ ♦ V^I^IZE * ^82 

- (ap21 921 ♦ i 9>22 q22)*12E*% (2.30.4) 

M,5 « (im 21 ♦ i^l2*2u) IicV 4»21 ♦ "PSl sM^ng^lll * 8l2E<ll?) 

(2.30 ) 

H|5 * (im 22 ♦ iq>l2422C) * * ap22 s^(4|lE9ii ♦ *12012^ 

(2.30.6) 

1^21 * H ,2 (2. M .7) 

^22 * *^0 l ^ (2.30.8) 

1o 

^23 * ♦ iie (*^ * **21 * ■022*122^ *®2 ^2.30.9) 

^2 

**24 * ♦12E(«2 * 2«^)J^82 “ ♦l2E^"p21q2i + «p22q22) 882 (2.30.10) 

M25 = (p»*21 ♦ «0l2 821E) (2.30.11) 

Mgg * (nw22 + Ripl2822E) (2.30.12) 

= M ^3 (2.30.13) 

**32 * ^*23 ( 2.30.14) 
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”33 • "l ♦ 

(2.30.15) 

H34 • («2 ■** "p 

(2.30.16) 

”35 • ♦llE^P^l c62 

(2.30.17) 

”36 “ ♦!!£ "P22 ceg 

(2.30.18) 

”41 “ ”14 

(2.30.19) 

”42 • ”24 

(2.30.20) 

”43 • M34 

(2.30.21) 

2 

H44 • «1 ♦(«2 ♦ «j ♦ np)^i2E 

(2.30.22) 

”45 * *12E®4>21 c92 

(2.30.23) 

”46 * **92 

(2.30.24) 

”51 “ ”l5 

(2.30.25) 

”52 • ”25 

(2.30.26) 
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c * ”35 


[Bi.d 


+ 'P .. ^ “ S''S 


J[2.30.27) 


M54 » M45 


(2.30.28) 


STi: anarj:>ficT iBdnrhwn stU up.b 


2 2 

^5 * "2 ®p *21E Jp ♦'21E ^ 

' r"-sr'35r" rrhr; •v'‘'3sr‘ ^ ^ 

f^56 ' i»P 421E*22E * "^P ♦'21E**22E ( 


(2.30.29) 


(2.30.30) 


.{'.-.r - ...ee “cr i' i i' -j 


* .'i 


”61 “ ”16 


(2.30.31) 


^'.(srPjsi^ ‘ tr»3f 

flB2* f^26 


".1^. — ( O ^ C.'»r'7 -f <*' 

o* »/■ r -'i- ' -‘i' ■ I r ^ ' / 

^ I 


(2.30.32) 


.D fiC:,; + 

>63 = ”36 


^ ^ - n >• 

' \ " 2 S " ' ^ ’ - r ! ' 


(2.30.33) 


^ oc I " V r P f ^ *■ V-: ‘ ^ ^ ^ 

' '%4 = ”46 " ' ^ (2.30.34) 


^ n . ^ 

; fW »• r - / J \ - 

>^S ■ »^6' '' 


v'i“ r-r fi' 3?^^-' I 


(2.30.35) 


f^66 * »»»2 ? ">p422E ■*" '^p*'22E 


2 ■■' 3 . 


(2.30.36) 


»■* ' -t- * • j' s . , ‘ . * • - > i , 

>iiiv*'' [(m^ '+ 2mj)|i $62 + (m2 + 2 mp)is( 4 ry + 82) + (ii^ ♦ mp) 


..,0 iPG~. ■ . .: 

I] s0^]g 


(2.30.37) 


’ r K* ' ’ *> 
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MB12 « (m2 + 2mp)^ gs(e^ + eg) 


and the nonllneir functions are 


(2.30.38) 


FI » 2(ii2 + "«p)UnEqi] ♦ ♦l2E**12^^^nE^n ♦l2E^12^®l " 

1 1 • 3 ^ 

(iHg + 2mp)l^l20^e2S02 ‘ (®2 ^^p) -1^ ®2 ®®2 " ^1®2®®2 

2 

(mp21 qg, + mp22 Qgg) - ("i2 + 2mp)(4^^^q^^ + ♦i2Efli2^^,se5 

2 ^ ^ 

~ (fiiE ^11 ^'I 2 E *^21 fl 22^®®2 ^21 

mp22 q 22 ) 62 C 6 g 3 + 2(m2 + ^nip) ^^^11E ^11 ^ ®12E ^12^®1®®2 


^ ^^llE *^n ^ ^12E *^'|2^®1®2^®2^ * ^***2 ^ *^11 ^ 

*12E ^12^®2®®2 ^ ^*11E ‘’ll * *12E ^12^®2^*^®2^ ^ ^ 

^^llE ^ ^ 12 E ^21 ^ ^^llE ^11 ^ 






^^ 2^1 ^ ^ 2 ^ * (nip 21 <^ 2 ^ inp 22 ^ ^ 2 ^ ^ ^^llE^ll^ 
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'*’ ®2^ * ^♦llE**!! ^ *12E^12) 

[(inp2lQ2‘| ^ iwp22(j22) (2® ■! ®2^^®2 ” ***p22cj22^®2 

(2e^ + 62 ) 562 ] (2.31.1) 

F2 - '*’ 4'|2£^12^^®'2 ^ 2inp) ^2 ®2^^2 "*” ^**^2 ^ 2mp)(4'j'j£Q|1 

2 

^12E^12^^1 2^ (mp21q2i "*■ •6p22422)^'j®'l^®2 "*" ^^llE*^ll'*^12E^12) 

6^(mp21q2^ + mp22q22)c62 + (">2 + 2mp) ^1^2 ®^^s 6 q + 1^6^362 

(mp21q2^ + mp22q22) + + *12E^12^ (6^+62) (m2+2mp)}| sSg + 

(♦llE^H ♦'|2E^12^®1 ®^P^^^22^^®2 ~ ^***2 ^***^^^— ^^llE^ll 

* 2 * 2 

^12E^12^^1 ^^2 ^ ^^llE^ll ^ ^12E^12^^1 ^ ^ 

1 ^ 0 ^^ (mp21q9^ + mp22q22)c62 (2.31.2) 

^3 = + e2)(ni2 + 2mp)e2se2 - (^^^^(mp21q2^ + mp22q22) 

®2^®2 ■ *11E^®1 '*' * "’P22q22)se-i + (>np21q2T + mp22q22) 

®2^®2^ ” ^*^^2 *''^P^®') ^^llE^ll "*" 1 2E^1 2 1 1 E ” ^*^2 "*” 
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(e^ + ^)s02^ - 4iiE^(nip21q2l ♦ «p22q22)se2 - ♦nE0l(ei ♦ ©2) 

(nf)21q2-) mp22q22)c02 (2.31.3) 

F4 •‘♦i2E ®2^®1 * ®2^^’™2 “*■ 2rop) S02 * ♦i2E^®®P2^21 * ®P22q22) 

T~ 

©2 s©2 -♦12 E(®i »2)[(®P21q21 + mp22q22)se2 ("P21q21 + «»p22q22) 

©2 ^©2] - (•'>2 *12E*1l2) “ ("*2 ■*■ 2n^)®12E®1 

(0^ +0 2 ) s®2 li “ 4 i2eM"*P 2^^21 + mp22q22) ®®2 ’ ♦l2E^ 

2 

(O] + 02)(inp21q2] np22q22) c©2 (2.31.4) 

F5 * -mp21 116^02502 + 2(4^^£qH + ♦^2E^12^'"P2l0ise2 + li©! 

(O] + 02)inp21se2 - (♦nE‘111 ♦l£E'*12)®l^®p21 C02 (2.31.5) 

F6 ® -irp22 liOi02 ®®2 2(4llEqil 4i2E^^2)®*P22 0^502 + 1]0] 

( 0 ^ + 02)mp22 $©2 - (♦llEqn ■*■ ♦i 2E‘^12^®1 "*P22 c©2 (2.31.6) 

where 


mp21 = mp ♦2IE 


(2.32.1) 
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m>22 « mp^2ZE * 


Equations (2.29) can be written in matrix form 


111 (t) i * Kl 1 + £l C u^ 


where 


M](t) » [M^j] i,j » I,--.. 6 






0 

0 

0 

0 

0 

0 


0 

0 

0 

0 

0 

0 


+F1 - MBll 
+F2 - HB12 
-F3 
-F4 
-F5 
>F6 

J 


0 0 

0 0 

-kwlll 0 


0 

0 

0 


0 -kwl22 0 

0 0 -kwZIl 

0 0 0 


0 

n 

0 

0 

0 

-kw222 


(2.32.2) 


(2.33) 


(2.34.1) 


(2.34.2) 


(2.34.3) 
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( 2 . 34 . 4 ) 


( 2 . 34 . 5 ) 


( 2 . 34 . 6 ) 


( 2 . 34 . 7 ) 
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A new set of variables can now be defined In order to write the equa- 
tions of motion (2.33) In state space form. 

In fact* If 

(2.35.1) C 4 * q ^2 (2-35.4) 

C2 *»2 (2.35.2) = q2i (2.35.5) 

?3 ■ qn (2.35.3) Cs - (\22 (2.35.6) 

equation (2.33) will be 

i«A'C+F' + C‘u (2.36) 

where 


[^1] 


[^ 1 ] 

1 =» 1 , ... ,6 

0 ' I 

A' = “ : - 

• — — r 

g 


F' = 



c 


i 


(2.37.1) 


(2.37.2) 


(2.37.3) 


(2.37.4) 


(2.37.5) 
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where x, x and £' are (12x1) vectors. A* is (12x12) and C* is (12x2) 
matrix. 


2.6 Linearized Equations 

Equation (2.36) Is used to study the motions of the proposed system 
imder some designed control component u^. For the purpose of design a 
linearized form of (2.36) Is obtained. In doing so. all sines and co- 
sines are first replaced by their series representation and then all 
terms of second- or higher degree In x^. 1 = 1.....6 are dropped from the 
equations. The resulting linearized system of equations can then be 
written as 


X = A £ VI 

where 


A * 



(2.38) 


(2.39.1) 


Q 


(2.39.2) 


and 


M = [M^j] 1, j » 1 


) • * • • 


6 


(2.39.3) 
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-MBin 0 0 0 0 

-MB! 21 -tfil22 0 0 0 0 

0 0 -kwlll 000 

0 00 -kwl22 0 0 

0 00 0 -kw211 0 

00000 -kw222 


(2.39.4) 


where now 

Mil “ (*^0 ('^ol "*■ + ( ni 2 + 2mp)l]l2C02 

(2.40.1) 


f’l2 “ ^-^ol Jp) + ("*2 + 2inp)il^ C02 (2.40.2) 

11^3 » (nwll + mjl]*^^^) + (m2 + mp)l]*nE + (m2 + 2mp)4i^E ~ *^®2 

(2.40.3) 

M^4 » (nwl2 + + (m2 + mp)li*]2E + (in2 2mp)^ *12E<^®2 

^ (2.40.4) 


Mi 5 = (nw21 + '^p^2^21E^ ^ ^1^®2 (2.40.5) 

Ml 5 » (nw22 + mpl2<t'22E) "*■ ’’^22 liC02 (2. ^0.6) 


H21 = Mi2 


(2.40.7) 
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• ^01 ^ 

(2.40.8) 

'•’23 “ 2 nip) h . C &2 

2 

(2 40.9) 

^24 * 4'|2E^***2 '*’ 2 nip) ^ CO 2 

2 

(2.40.10) 

H 25 “ nw 21 + mpl 242 lE 

(2.40.11) 

M 26 = nw22 + mpl 2 * 22 E 

(2.40.12) 

M3I “ 

(2.40.13) 

II 32 « H 23 

(2.40.14) 

”33 “ "’1 ■* ''"2 + "’j + n^)^llE 

(2.40.15) 

M 34 = (m 2 + nip + *12E 

(2.40.16) 

M 35 * ^i^^mp 21 C 02 

(2.40.17) 

f^36 “ ^nE"’P 22 C 02 

(2.40.18) 

M 41 - Ml 4 

(2.40.19) 

H 42 » M24 

(2.40.20) 
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»43 ’ ”34 

(2.40.21) 

2 

M44 " mi + (m2 + mj + mp)4i2E 

(2.40 22) 

M 45 “ «M2Emp21 C02 

(2.40.23) 

M4g * ^'|2£^np22 083 

(2.40.24) 

M 5 I = Ml 5 

(2.40.25} 

M52 = M25 

(2.40.26) 

M 53 * M 35 

(2.40.27) 

M54 = M45 

(2.40.28) 

2 2 

H55 » m2 + mpi|»2iE + JP+21E 

(2.40.29) 

M 56 ® mp4'21E'J’22E ■*■ '^p'^’ZlE ‘•’22E 

(2.40.30) 

Mei = "16 

(2.40.31) 

"62 ‘ "26 

(2.40.32) 

"63 “ "36 

(2.40.33) 
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M64 “ M45 

(2.40.34) 

“ M55 

(2.40.35) 

2 ,2 

^66 ® ni2 + mp422E ■*■ JP*22E 

(2.40.36) 

MBin ■ [(m] + 2tHj + 2ni2 + 2nip) c®i + (m 2 + 2mp) — 

J K 2 *'2 


c(®i + ®2)^9 

(2.40.37} 

MBil2 = [(m 2 <■ 2mp) g c(6^ + ^ 2 ^] 

(2.40.38) 

MB121 = [(m 2 + 2mp) 1 ?. g c( ^ + 02 )] 

(2.40.39) 

MB122 = [(m 2 + 2mp) ^ g c{e^ + 62 )] 

(2.40.40) 

Xi = 01 - 0, 

(2.41.1) 

X2 = ^ - ® 2 

(2.41.2) 

^2 “ 911 

(2.41.3) 

X4 = qi2 

(2.41.4) 
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5 * <*21 

(2.41.5) 

=6 “ *»22 

(2.41.6) 


wit I and ^2 being constant angles at sone Instant t. 

2.7 Exper»nenta1 V »* r1f1 cation 

To know how well the model represents a real system an experiment 
was designed and built. It consisted of two cari)on steel hews pinned 
together by a joint that allows motion only In the plane of the beams. 

One of the ends was connected to a torque motor for excitation and at 
the other extreme a payload was clamped as Indicated In Figure 2.4. The 
joint '.;as represented In tiie model by a lumped mass at the end of the 
first beam. The experiment was performed In the vertical plane In order 
to have the effects of the gravitational field. The frequency spectrum 
shown In Figure 2.5 was obtained by automatic frequency sweeping and 
measurement of the acceleration of the end point via an accelerometer 
mounted on the pj^load. As the model only takes Into account two nodes 
for each beam, the overall system presents two rigid and four flexible 
natural frequencies. Table 2.2 summarizes the flexible resonant fre- 
quencies and the error relative to tlie experiment. As one can verify, the 
results are quite good If one takes Into account all the possible measure- 
ment errors that might have been Introduced by the automatic sweeping 
without allowing the system to reach tiie steady state. Another source of errors 
could well be Introduced by the value of motnc>nt of Inertia of the torque 
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Units: slug-ft-sec (kg-«-sec) 



0.019 9-6»^ _ 0.862 0.325 

(0 200) K-0191) I (0.269) | (.099) 


Torque Motor Rotor Inertia * 3.98x10”^ ft-lbf-sec^ 

(5.75x10“^ nt-m-sec^) 

Beams: diameter - 0.25 in (0.00635 m) 

material: carbon>stee1 

material: AluMiinum 

mass * 1.23x10*^ slugs (0.0179 kg) 

Payload _ 4 875x10“^ slugs ( 0.0711 kg) 

Jcg * 0.395x10"^ slug-ft^ ( 0.669x10’^ kg-m^) 


Figure 2.4 - Experimental Verification - System Parameters 
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uoi^w3[3DDV ^0 apn^^'Juiv 


Figure 2.5 - Frequency Spectrum - Experimental Results 
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motor, which was obtained from a motor catalogue. As has been observed 
by W.J. Book [B2]. a reduction of 30X In this value would lower the 
first three natural frequencies about 3.7S. 

Another comparison of results was performed between the proposed mod- 
^1 and the transfer-matrix procedure used In [B2]. For this purpose the 
chosen system was the correspondent model of a 53.4 ft. long manipulator. 
The dimensions are summarized In Figure 2.6 and the results In Table 2.3. 
In this case no gravity was taken Into account and Table 2.3 presents 
the first four flexible natural frequencies. 

From the results presented In these two comparisons, one might as- 
sume that the model gives a good representation of the proposed physical 
system with probably loss of significance only In the highest frequency 
due to truncation error. This kind of error was also observed when 
the proposed modeling procedure was applied to a single pinned-free beam. 
Table 2.4 presentes some results comparing the proposed model applied 
to a single pinned-free beam in two situations: forced by the same torque 
motor and analytical values with dimensions shown In Figure 2.7, both 
cases assuming truncation at the second flexible mode. 

2.8 Htwerical Evaluations 

As the nunber of modes Introduced in the model Increases, the sys- 
tem becomes more and more numerically stiff [LI]. This fact Is reflect- 
ed In the numerical calculations of the eigenvalues of the mathematical 
model. The previous results in this work v/ere obtained by using a mini- 
computer Interdata Model 70, with 40K 16 bit v/ords of core storage ail- 
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Units: slug-ft-sec ( kg-w-sec) 



Beams, diameter * 0.75 ft (0.228 m) 

Internal diameter = 0.734 ft (0.223 m) 
mass » 5.278 slugs (77.021 kg) 

lumped mass * 1 slug (14.592 kg) 

Payload 

mass = 15.54 slugs (226.76 kg) 

J „ = 12.62 slug-ft^ ( 21.37 kg-m^) 
diameter * 1.0 ft (0.304 m) 


Figure 2.6 - Characteristics of system used for comparison 
with transfer-matrix method 
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•A ? 

Torque motor rotor Inertia: 3.98x10 (Ibf-ft-sec) 

(5.75x10"^ mt-m-sec^) 

diameter « 0.25 in (0.0635 m) 

material: carbon steel 

a) laboratory experiment 


material: carbon steel 
diameter » 0.01 ft (0. 00304m) 


b) analytical example 

Figure 2.7 - Characteristics of a single pinned-free beam 
for model verification 
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Experiment 

Model 

msm 

80.76 

79.34 

1.7 

136.6 

130.68 

mm 

i 

244.6 1 


15.5 

401.6 


21.4 

417.0 

487.56 



16.9 


Table 2,2 Flexible Resonant Frequencies and 
Relative Error 


Model 

Transfer-Matrix 

39.7 

38.1 

57.9 

53.2 

144.5 

— 

; 143.6 

189.1 


279.5 




unit: rd/sec 

Table 2.3 Comparison between the proposed model 


and transfer-matrix procedure 
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Analyti cal 


ttodel 

Exact 

Error 

313.2 

308.3 

1.5S 

1016.16 

1191.58 

17.2* 


Experimental 


Model ! Lab. Exper. 

Error 

^ 

615.7 

i 

606.46 

1.5* 

j 2513.3 

2112.16 

1 

15.9* 

i 


units: rd/sec 


Table 2.4 Analytical and Experimental Results from a Single Plnned- 


Free Beam 
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able at M.I.T. Joint Civil -Mechanical Engineering Computer Facility. 
The general programs are listed In Appendix A. As the storage capacity 
of the computer used was small compared with the size of the program, 
the operations were performed utilizing disk storage. 
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CHAPTER III 
COfiTROL TECHNIQUES 


3.1 Introduction 

This chapter gives a general description of the techniques that 
were applied to the analysis of controlling flexible manipulators. 

These techniques, with one exception, were applied to the models pre- 
sented In Chapter IV and the results are discussed In the next chapter. 
In order to Introduce these control procedures one can start with 
equation (2.36) which represents the nonlinear model of the physical 
system 


T = A' 1 + F' + C' u (2.36) 

The objective Is to find a control law £(i_,T_,t) such that the sys- 
tem response follows the desired specifications. This task Is compli- 
cated by the presence of the nonlinear terms In the system representation. 

Even In the case for which the control law can be exactly specified. 
It would In principle be useful only In very specific cases. To avoid 
this type of design of the control one can always design the compensation 
for the linearized model and verify how good the approach Is when applied 
to the nonlinear system. 

From the linearized equations of motion 

X = A x + B u 


(2.38) 
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the structure of a linear regulator can be represented as in the block 
diagn u of Figure 3.1 



Figure 3.1 Block Diagram of the Compensated System, 
where the control has been replaced by the linear equation 

u=Kx (3.1) 

and )y) is the desired trajectory. 

The purpose of this chapter is to present several techniques that 
were used to compute the set of gains K for different feedback alter- 
nati ves . 

3.2 Modal Analysis 

It is well known that in the case of linear time invariant systems 
described by state equations of the form 

X “ A X + B u 


(3.2) 
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where A and B are (n x n) and (n x r) matrices respectively, a model 
representation can be obtained by using a nonsingular transformation of 
state [C3], [Si]. 


X * U 2 


(3.3) 


In the case of distinct eigenvalues of matrix A, matrix U Is the 
modal matrix of A and Its columns are the eigenvectors of A [Gl] [C3], 
Then equation (3.1) becotres 


Z = A Z + P ' u 


(3.4.1) 


where £ Is the diagonal matrix of the eigenvalues of A 


\2 O 


O 


(3.4.2) 


and 

pj = U^-1 b = vT c 

Is the mode controllability matrix with 


(3.4.3) 


U « 1 

where I Is the Identity matrix. 


(3.4.4) 
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It is clear from equations (3.4) that thr . -ans formation (3.3) 
uncouples the n-th order system into n uncoupled subsystems. Also it 
is evident from equations (3.4) that the ith mode of the uncoupled sys- 
tem is controllable by the jth control input if and only if 

Pij » V J ^ ^ 0 (3.5) 

The controllability of the system is immediately verified by exam- 
ining the components of the mode controllability matrix . 

Equations (3.3) represent an uncoupled system giving rise to one 
important question: is it possible to find a ''ontrol law ^ such that the 
eigenvalues can be specified a priori? The answer to th‘ ' question was 
initially given by Rosenbrock [Rl] and his presentation of modal control. 
Several extensions and improvements have been made since then [El], [PI], 
[P2] and a very useful algorithm was presented in the work of Simon and 
flitter [SI], [S2] for the case of distinct eigenvalues. A more recent 
work by Gould, Murphy and Berkman [G3] extends this algorithm for repeated 
eigenvalues. The constraints in the number of inputs in the present work 
make the Simon-!li tter algorithm the most suitable for applications. For 
this reason a brief presentation of this method will follow in a simpli- 
fied way as it was applied. A rigorous and general formulation can be 
found in reference [S2]. 

3.3 Simon-lii tter Algorithm (SMA) 

Tins algorithm is capable of shifting all the eigenvalues to desired 
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location with only one application. However, this procedure may 
cause numerical difficulties in the soU'ticn of a large nunber of ill- 
conditioned equations. On the other hand, the shifting technique is 
recursive, that is, a small number of poles can be shifted in each ap- 
plication of the algorithm and this procedure may be applied as many times 
as is necessary. If a number p of poles is to be shifted the solution 
involves an inversion of a (p x p) matrix. For this reason a recursive 
design shifting two poles each time was used, wh^jh means that the pro- 
cedure would involve a small amount of comput<v core for each change of 
poles. When two poles are moved, the gains to form the control law 
are such that two poles go to a new specified position while all the 
others remain fixed. If a new pair of poles is modified, the gains are 
all added to the old ones in order to maintain the former shifting of 
poles. This procedure has a disadvantage with respect to numerical er- 
rors accumulation but it is useful when few poles have to be shifted. 
Again, the only restriction is that the system has .10 repeated poles. 

In order to illustrate the two pole shift procedure one can recall 
the renonicrl form (3.4.1) 

Z = _AZ + P^u (3.M) 

The question is to ^ind a linear state variable feedback law 

u = Gz = l^x (3.6) 
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MP.Ich Moves the two selected poles to specified location while the 
other poles renain constant. If one chooses to change the polesx-j and 
^2 toY-| and >2 and assuHe that the system has r Inputs the feedback 
taw becoMSs 


“ “ ai 1.1 * 32 ^2 * 

911 

921 

2(1^ X + 

912 

922 




9r2 


^ X 


(3.7) 


Sii>st1tut1on of (3.6) Into (3.4.1) yields the new system 


z * A z 


where 


(3.8.1) 


L - A + P'G 


(3.8.2) 



(3.9.1) 
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where 

*ik * £j^ i » k * (3.9.2) 

To determine the new eigenvalues It is sufficient [SI] to examine the 
eigenvalues of 



^ ♦ *n ‘i2 
*21 *2 * *22 


(3.10.1) 


In fact, from the mode decomposition property (Appendix B) 


. n 

det(si - A ) = ,, (s- X.) - det (sl^ - a,i) (3.10.2) 

- j=3 

If now the new pair of eigenvalues is Y] and Y 2 it is sufficient to 
equate the coefficients of like powers of the identity 


(s - Yi)(s - Y 2 ) = det[sl_ - (3.11) 


and consequently find the conditions that must be satisfied by and g2* 
However, £^and £2 vectors whose dimension depends upon the nunter of 
inputs to ^he system. If the system has a single input it is clear that 
(r 10) will give a unique solution for tne control law £. On the other 
hand, if r ^ 1 there exist an infinite number of components for £-j and £2 
that satisfy (3.10). Several alternatives exist to produce a unique sol- 
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utlon for the control. Among these techniques are those based on power 
requirements of the system, sensitivities, proportionality between con- 
trol elements, etc. For the purpose of this application the criterion 
used Is the fixed ratio of feedback gains , that Is, the vectors 3 ^ and 
32 **ere r^laced by niao ^23 q >^spect1vely. The vector 30 Is us'ially 
chosen on the sense of satisfying some desired condition. In particular, 
the selection of the elements of ^ by the rule [Si] 

9io * (Pll^ ’ * (3.1?' 

maximizes the measure of controllability and hence requires the least 
absolute value of feedback gains. This rule was used throughout the ap- 
plications. Since 3q Is specified the algorithm gives a unique solution 
for a shift of a pair of poles. This solution can be presented for two 
cases: pair of real poles and a complex conjugate pair. In particular, 

the numerical implementation becomes easier when these two cases are 
taken into account. 



(3.13.1) 


where 
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- Yi + Y2 - M - ^2 

(3.13.2) 

C2 « Yi Y2 - 

(3.13.3) 

®l(o ~ fik^ ^ k * 1 ,. . . ,n 

(3.13.4) 

and the control law 


u * 3o C”l.)^l ^ 

(3.13.5) 

3.3.2 Complex Conjugated Poles 



For this case, in order to assure that ^ is real let 

+ jX^ (3.14.1) 

Xg = Xi* = x^' - jX*^ (3.14.2) 

and from the mode controllability matrix let 

J^ = Pl'+jPl" (3.14.3) 

^ = Pl* = Pi' . j P^“ (3.14.4) 

+ j j:i 


(3.1^5) 
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V]* * vj* - jvf 


(3.14.6) 


Then, the solution of 


n' 

M 

p/'ao 

-p/"ao 

-1 

^1/2 

n" 





(c2 - Al'el)/2X1" 






- 


(3.14.7) 


leads to the control law 


u = 2ao[n'y^,* - x 


(3.15) 


The transformation of a real pair of poles into a complex pair and vice 
versa can be easily obtained by successive numerical applications. 
Appendix A presents the computer program used for the applications of 
modal control using this algorithm in a recursive way. 


3.4 General Rigid Gains - Cross Joint Feedback (GRG) 

The preceding algorithm when applied to system (2.38) can move any 
pole to the desired position. However, the control law used for this 
pole shifting will involve the measurements and/or estimation of all 
state variables associated with the physical system. Although the pos- 
sibility of using measurements of all of the variables is not impossible, 
another technique was used in order to comp ire the results Essentially, 
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this other procedure Is to compute the gains ror the control of a two 
link rigid manipulator and apply them to the flexible model. The con- 
trol for the rigid system would use only position and velocity feedback 
gains Involving the joint state variables. Several mettiods exist to 
compute this kind of gains butone particular procedure suggested by 
Professor O.E. Whitney [W1] seems appealing because of Its similarity 
to a modal approach. A brief description of this method Is presented 
below. 

Cons der a pure rigid two link system with no damping and no joint 
compliance represented by the equations 

(3.16) 

where J Is the (2x2) Inertia matrix of the system, is the (2x1) vector 
of control torques and n is a vector with components and shoulder 
and elbow angles in the rigid system respectively. In termsof state 
variables (3.16) can be written 



(3.17) 


where Is the identity matrix. 

The torques are obtained via a control law 

x»Bu (3.18) 

with B a (2x2) matrix and 

^ * JlTii llTD-? 


(3.19) 
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where ts a (2x2) angular position feedback matrix and Is a (2x2) 
angular velocity fee(tt>ack matrix. The elements of I(t and can be ob* 
talned for some desired specifications with respect to the position of 
the poles In the complex plane. The system (3.16) with (3.17) and (3.18) 
bec«nes 


• 

a 


0 

1 


a 

• » 
Q 


1 

J'^BkTn 


• 


If now and lyg are chosen so that (*) 








-2ciwi 


0 


0 

- 2 ^ 2^2 


( 3 . 20 ) 


(3.21.1) 


(3.21.2) 


It is clear that the system (3.16) will become a set of two uncoupled 
differential equations with natural frequencies w-j and W 2 and damping 
ratios C-j and ’^2 respectively. This choice of kj and kyg is not unique 
but it is convenient because it allov/s one to place the poles by inspec- 
tion. Then, this procedure enables one to specify the desired charac- 
teristic of the system and as a consequence find the corresponding angular 
position and velocity feedbacks. 

Since for a real system the inertia matrix is always non-singular, 

(*) w and u> are used interchangebly to represent angular frequency 
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the only restriction to the technique Is that the control matrix Is 
non-singular. Tnis fact makes Impossible the application of this pro- 
cedure to the flexible model Itself but some variations of the control 
derived from a corresponding rigid model can be applied to the flexible 
system. Also It Is In^rtant to notice that the matrices Kj and 
are not necessarily diagonal which means that the control can take Into 
account feedback between the joints. Finally this procedure can be applied 
to a rigid arm witli any number of joints. A trivial generalization allows 
the procedure to be applied to any controllable and observable lumped 
passive dynamic system although an observer may be needed, 

3.5 Rigid Gains - Mo Cross Joint Feedback 

This case Is a particular way to find the Ky and ‘rices In 

the preceding method. As was mentioned before, the effect of cross joint 
feedback disappears when Kj and JKjq are chosen diagonal matrices. Using 
this procedure W.J. Book [B2] achieved Interesting results for the design 
of control for flexible manipulators. This method was not applied In the 
present work except as a means of comparison of different control techniques. 

3.6 Sensitivity Analysis 

Another procedure used to find the components of the control law 
u dealt ;ith the sensitivities of the poles with respect to variations in 
the gains. If one assumes only angular position and velocity feedbacks, 
the nimiber of control elements would be considerably reduced and by 
inspection the gains could be changed based on their corresponding sensi- 
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tivltles. 

Consider the system represented by 

X = A X ♦ B u (2.37) 


and assume that 


u s K X 


(3.22) 


where A Is (nxn) matrix, ^ is (nxr) control matrix and K is (rxn) gain 
matrix. For example, equation (2.38) could represent the linearized model of a 
flexible manipulator. The eigenvector uj associated with the jth eigen- 
value is defined by the equation 

A Uj - XjUj (3.23) 


If Vj is the corresponding element in the reciprocal basis, from the 
orthogonality of the modes 



= 0 for i # j 
^ij * ^ ^0'^ i ® j 


(3.24) 


From (3.23) and (3.24) 


-j iJij ■ ’■i 


(3.25.1) 
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It is easy to verify that the only left hand side term Involving 
the element a^|^ 


... + + ... » (3.25.2) 

Then, from (3.24) and (3.25) the sensitivity of the eigenvalue Xj 
with respect to variations In the element of the A matrix Is given by 
[VI] 


|M * (3.26) 

°®1k 

If now the control law (3.22) Is taken Into account, equation (2.38) re- 
decues to 


X 


A X 


(3.27.1) 


where 


A * A + B K 


(3.27.2) 


with components 


r 

'’IkSkj 


(3.27.3) 
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Now, the sensitivity of a pole with respect to gain gj^ is 


3 ^ 


n r 

E I . 35lj 

i-1 k»l ag,tj 


n r _ 

z ( z 2iii_) (3.28) 

i»l aa^j k»l agj^j 


But 


Then it follows from (3.28) and (3.29) that 

n 

3V» = Z (3.30) 

aOkj 1=1 aa^j 

From (3.30) and (3.26) one can see that if the eigenvectors corresponding 
to a certain configuration are known. It <s possible to analyze the effects 
of local pole variations for each component of the gain matrix. This pro- 
cedure will be explained numerically In the next chapter. 

3.7 Summary 

This chapter presented a brief description of the control techniques 
used In this work. The next chapter presents the application of these 
techniques to some nondimenslonallzed examples and general results ob- 
tained. 
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CH/VPTTR IV 

APPLICATIONS AND RESULTS 


4.1 Introduction 

The purpose of this chapter Is to Introduce the example systems used 
In the applications of the mathematical techniques and the general results 
obtained from the several control methods. Two examples have been chosen, 
both with circular ring cross sections. The first one (example 1) Is a 
very long and flexible beam of two equal segnents carrying a payload that 
might vary In size and weight. The overall dimensions are shown In Figure 
4.1 and were obtained from reference [Nl]. 


shoulder elbow 

joint joint 


5 


5 


26.7 ft 


26.7 ft 


(8.13 m) 


(8.13 m) 


payl oad 


variable 


Bead’s diametgr ■ 0.75 ft (0.228 m) 
Internal diameter ■ 0.734 ft (0.223 m) 
material: Aluminum 
E - 10^ psi (7.0x10^^ Pa) 


Figure 4.1 Example 1 Characteristics 
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The second example (example 2) 1s a more rigid system with fixed p^load. 
The most Important difference is that the beams have different radii and 
were chosen such that the stiffness El for the first beam is approximately 
equal to six times the value for the second beam. The main geometric 
characteristics are presented in Figure 4.2 and were obtained from re- 
ference [R2]. 

shoulder elbow payload 



Beam 1 ‘external diameter « 3.74 in (0.095 m) 

internal diameter » 3.15 in (0.080 m) 

Beam j^anieter = 2.36 in (0.060 m) 

internal diameter = 2.00 in (0.051 m) 

Material: Aluminum E * 10^ psi (7.0x10^^ Pa) 

Joint lumped mass * 0.932 slugs (13.6 kg) 
Assumed payload: 

0.623 slugs 0.623 slugs 

(9.1 kg) (9.1 kg) 



Figure 4.2 Example 2 Chararteristics 
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With respect to all the applications of the described models, the 
motions were assumed to be in the plane of the beams, no structural 
damping was considered and gravity was neglected. However, the computer 
programs presented in Appendix A can accommodate damping and gravity. 

4.2 Nondimensionalization 

In order to have a better idea about the effect of the system para- 
meters and also to obtain more general results, a system nondimensional- 
ization was performed using the quantities given in Table 4.1. 


Physical Quantity 

Symbol 

Dimension 

Stiftiiess constant of 



beam 1 

Ell 

FL^ 

Total length 

1 

L 

Average Mass/ unit 


FL-2t2 

length 

y 


Table 4.1 Parameters for Nondimensionalization 

where 

1 Ml + l2 (4.1.:: 

will + V2\z 

y = X (4.1.^) 

Two important quantities can be derived from Table 4.1 


- time 


/ul3 
Td = v/nr 


(4.2.1) 
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“frequenqf 



(4.2.2) 


It Is iMportant to observe that frequenqr w,} h«is no associated physical 
systea but can be easily related to any systen natural frequency. For 
exiMpie, If one con:>1ders a beam with stiffness length \ and density 
pet unit length v, the claivped-free natural frequency Is given by 



Then It follows that the relationship between frequencies W(j and Wc Is 
simply given by 


Wc = 3.52 wd (4.«' 

Any results with respect to wd can then be extended to compare with Wc. 
If now one introduces: 

- ratio of the radii of beam 1 


k 


rl 


= 111 

>"el 


(4.5) 


- ratio of the radii of beam 2 
•"re re2 


(4.6) 


it is possible to establish a constraint among the stiffness constant. 


the radius and the density of the beams. In fact. If one assumes the 
ratio of .a radii for each beam and also the nondi mens lonali zed stiff- 
ness constant of bean J, the following relationships are useful for the 
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nondlnenslonallzatlon of the remaining parameters. 
In fact. If 

r. = (— )^ 

^*2 * Ell (1-krl^) 


then 


rel' 


/- 0-krl’) 

'"2 (T:i^) 


Also, from (4.1.1) 


Pill +y2l2 - - 

u * ^ *'*‘>ll ♦ **2l2 


or 


“ill ♦ “ 2 I 2 * 1 


On the other hand, for cylindrical be. 


u s P»[lirei^(1-kpl2) + I2re2.^(l-kr2^)l 


and 


^ pirrei^yl-tri^) 

»*2 ' P^direi2(l-M2) + I2re22(l-k^2^)] 


(4.7.1) 


(4.7.2) 


(4.8.1) 


(4.8.2) 


(4.9) 


(4.10) 
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or, using (4.7) into (4.10) 


^1 * ^ l^h 0 Vig)(l - kr2^) 

(1 ♦ kr2^)(l - kp^2) 


(4.11) 


and from (4.6) 

TTJ ^ ^ 

Ij (4.12) 

Then, assunring the value of ET 2 , the ratio and kp 2 » the lengths 
Ti and Ip and one of the external radii, exnressions (4.7), (4.11) and 
(4.12) define the other characteristics of the system. 

Using EI],pand I the nondimens ionali zed groups are shown in Table 


4.2. 



86 


NondImen ilonal 1 zed Quanti ty 

Equations 

stlf^ess constant of beam 1 

Hi = EIi/EIi 

stiffness constant of beam 2 

El2 * EI2/EI1 

length of beam 1 

ii = ii/i 

length of beam 2 

l2 * l2/l 

length of payload 

Tp * Ip/l 

Internal diameter of beam 1 

II 

Internal diameter of beam 2 

dl2 * di2/l 

external diameter of beam 1 

del * del/l 

external diameter of beam 2 

^2 = de2/l 

density per unity length: beam 1 

Ml * m/u 

density per unity length: beam 2 

i»2 = m2/m 

payload mass 

mp = 

elboM joint lumped mass 

ij = mj/ul 

mass moment of inertia 

J = J/m13 

time 

f * t/Td 

frequency 

w = w/wd 

angular position feedback gain 

kap = kap/(EIi/l) 

linear position feedback gain 

kip - kip/EIi/l2) 

angular velocity fee<fi>ack gain 

kav = kav/(EIi/wdl) 

linear velocity feedback gain 

kiv = kiy{EI^/wdl2) 


Tabic 4.2 iiondii^cnsionallzed groups 
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4.3 The Control Application and Ann Bandwidth Definitions 

In order to apply the control techniques described In Chapter III 
It Is helpful to know some details of the gain matrix j( that appears 
In equation (3.1). The model described In Chapter II was assuned to have 
two Inputs, namely the torques t-| and t 2 applied at shoulder and elbow 
joints, respectively. As the model Is described by 12 state variables. 

I( Is a (2x12) matrix. The general fonn of this matrix Is 


r 1 


•^11 *^12 

•'13 

•'14 •'15 

•'16 

•'17 •'18 

•'19 

•'no 

•' ll ! 

•'112 

•'21 •'22 

•'23 

•'24 •'25 

•'26 

•'27 •'28 

•'29 

k 210 

•'211 

•'212 


(4.13) 

where 

kii. k]2> k2], \f-z2 angular position feedback gains; k]3, k]4, kis, 
kl6f k]7, k23, k24» k2s, k25, k27 are linear position feedback gains; 
kl7, ki8, k27, k^s are angular velocity feedback gains; kig, ki^g, k^]], 
*^112* *^29» •'210, k2ll, k2l2 are linear velocity feedback gains. 

It Is obvious that the linear feedbacks will necessarily require 
measurements and/or estimation of flexible displacements and velocities 
while the angular feedbacks are based essentially on the measurements of 
angles. This Is an important fact In comparing the results from the 
application of general rigid gains design method and Simon-flitter algo- 
rithm. ftodal control will involve the set of 24 gains while In the 
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other case 8 at most are necessary. In the special case where no cross 
joint fee(fi>ack Is taken Into account, only four gains are used [82]. 

Dim to the large number of gains, the analysis via a not locus for gains 
variations Is Impractical. 

The remaining parts of this work will frequently mention arm band- 
width when comparisons or simulations are presented. There Is a certain 
arbitrariness In defining the bandwidth of a manipulator arm. For this 
reason this work defines arm bandivldth as the maxlmun undented frequency 
for which the two first dominant poles are as close as possible to 0.707 
damping ratl^. The following results are concerned with the arm band- 
width obtained by using the control techniques presented In the previous 
chapter. 

4.4 General Rigid Gains Method Applications 

For the implementation of this method one nondi mens Iona 11 zed example 
was chosen with the following parameters: 


l^rl “ ^r2 " 

Jp = 0.0 





Ell = 1. 

Ip * 0.0 

- 



El2 = 1.0 

ll * 0.5 

Pi = 1.0 

l2 = 0.5 

o 

It 

CvJ 

i;:l 

r^l = 0.05 

mp = 0.0 

Fg2 ~ 0.05 

m j = 0,0 

: 

e^^ = 0* 
02 = 0“ 


Tabe 4.3 Nondimensionalized Parameters of Example 3 
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Similar tables for examples 1 and 2 can be found In Appendix C. 

In order to obtain some results using this method one has to use an 
equivalent rigid model that In the case of present work Is represented 
by a double pendulum with Inputs at both pinned joints. It Is evident 
that only angular position and velocity feedback gains will be present 
In such a model. If equ' ions (3.2.1) are recalled, one will notice 
that to find the matrices Kj and ]1 td» necessary to specify four 
parameters of the desired system, namely, wi, wp, , Cp. Once these 
values are specified, one can obtain and such that the poles of the 
closed loop system will be exactly at the desired location. These gains 
can now replace the angular position and velocity feedbacks on the gain 
matrix (4.13), corresponding to the flexible case. In this way It is 
possible to analyze how effective the method is for several variations in 
the parameters. The following steps tepresent the application procedure: 

a) choose the desired values of the first two dominant modes t 
that is, w], wp, t], ^ 2 ‘, 

b) using (3.21) appl’c.d to the rigid equivalent model obtain the 
gain matrices Kj. Kjg; 

c) construct the gain matrix K expression (4.13) using ^7 and 

d) examine the closed-loop poles of the flexible system. 

The limiting range of this method will be determined by the deviation 
of the dominant poles of the flexible model from the desired specifications. 

This sequence was applied to the example of Table 4.3 with the 
frequencies nondimensionalized by (4.2) and the assumption 
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w^ = W2 ® w 

(4.14a) 

Cl * t2 * 4 

(4.14b) 


where 


W = W/W(j 

It is important to mention that assumption (4.14) was used because it 
yields symmetric matrices and JCyo. This fact will make the control of 
the flexible model analogous to spring and dashpots actuating among the 
joints and consequently assuring stability for the system. Some results 
were obtained for \i} t W2 as can be seen in Figure 4.3 Hcwever to as- 
sure stability (4.14) assumption was used throughout the work with damping 
ratio 4= 0.7 as a constant parameter. 

For this damping ratio c the frequency w was specified and gains 
jCj and Kjo were obtained via the rigid model; these gains when applied 
to the flexible model returned a pair of dominant poles which were plot- 
ted as a root-locus of the first two dominant flexible poles. The locus 
is shown in Figure 4.4 for damping ratios of 0.5, 0.7 and 0.8. A reas- 
onable understanding of the results can be obtained by plotting both 
pole on T. ..ame graph. One can see that for w = 1.0 the resulting be- 
havior of the flexible system is essentially the same as the rigid one; 
the dominant poles are close together with damping ratio 0.7. As the 
value of w is increased, the poles of the flexible system start separating 
and for w over 3.0 there is a shift v/ith respect to the distance to origin 
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Re(2ju)/(>/l+ET2l) 

Figure 4.3 - Root loci of dominant poles - GRG Control for constant 
damping ratio c * 0.7 and u>^ * 1^2 


Im(2j5/(v/l^)) 
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Figure 4.4« - Detail root loci of dominant poles 
GRG Control varying ^ 



Re(jw) 

Figure 4.4b - Detail root loci of dominant poles 
GRG Control varying u 
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and the dominant pole becomes the one that has u smaller damping ratio. 
On the other hand, If one recalls expression (4.4) It is easy to see 
that this relationship holds for the present example. Consequently 


w = w = 1 w 

^ wj 02 • wc 


(4.15) 


Is useful to compare the preceding explanation with respect to the 
natural frequency of a clamped- free beam associated with ti e system. U- 
slng (4.15) one might say that the method of general rigid gains yields 
very reasonable results for manipulator bandwidth up to the natural 
frequency of the clan^ed-free equivalent system. Faster response can 
be obtained only with a considerable reduction In the damping ratio of 
the dominant mode. For constant specified damping ratio oft =0.7 
Figure 4.5 shows the dominant flexible poles for variations In vT. This 
plot presents a better view of the limitations cbtaiued from the general 
rigid gains method. 


4.5 Effect of Payload 

In order to analyze the effect of the payload In the design of the 
control, a comparison was made between three different payloads for 
the example presented in Table 4.J. The payload? were assumed to be 
lumped masses at the end of the second beam with values Indicated In 
Table 4.4 



GRG Control 
i « 0.707 
m »0.0 

rf, -ETj 


Values of u for each case: 

0.5,1 .0,2.0.3.0,4.0,6.0,8.0,10.0 
15.0,20.0 



-12.0 -9.0 -6.0 -3.0 0 

Re(2jW( yi‘+Tl2)) 

Figure 4.5 - Root loci of dominant poles - GRG Control varying u 
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case 

'"P 

n 

1 

0.8 

1.63 

2 

1.0 

1.44 

3 

5.0 

0.75 


Table 4.4 Lumped Payloads Assumed for Example 3 
The natural frequency of the clamped-free equivalent ry«:tem is vIq 
with ct obtained using the method presented in refei ►■.iice [Bil. The in- 
sults can be seen in Figure 4.6 As the payload is increased, the arm 
bandwidth is reduced as a consequency of the lowe. 'ystem natural fre- 
quencies. If one assumes the best design situation to be as close as 
possible to a damping ratio of 0.7 one sees that the general rigid 
gains method can still be applied with good results up to close to the 
clamped-free equivalent natural frequency. The situation would be con- 
siderab? different if rotary inertia of the payload were considered. 


4 . 6 Variations in S ystem C-'ometry 

In the preceding discussion only the case of equal cross section was 
verified from the point of view of control application. However, it 
would be ' >eful to know how the system geometry ..as to be taken into 
account in order to improve the am bandwi .'th. In order to implement 
this idea it is necessary to meniion some important aspects. First, 
the system is going to be assumet.!. .is in the previous cases, '/ith two 
beams of equal length. Then, in order to keep a good reference fr-r 
comparisons, tne sum of the masses of the beams is assumed to be constant 
and the only variations must occur 1i, the radii of the beams. In doing 





I 


(D 

« 

o 

• 

00 

a * 1 .63 

(D 

■ - 1 .0 
p 

a • 1.44 

(D 

ip - 5.0 

a • 0.73 



ReCZjfcj/Cyi + fT^)) 


Figure 4.6 - Root loci of dominant poles - GRG Control 
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so let one assine 

jn-| + m 2 = m = constant (4.16) 

♦ I 2 ® 1 - constant (4.17) 

If- P is the density of tJie material, equation (4.16) can be written 

P l> - ‘lel^O-l'rl^) I 2 - de2^(1-'^r2’) * (4.18) 

4 4 

or, using the nondimens ionalizati on from Table 4.1, (4.18) can be re- 
duced to 


. ( !^ )^ l2(I k 2) . 
rei 


m 




(4.19) 


If now one uses equation (4.7) there results 

d„,2 = (_1!1_) U. ) 

llllzlfl (4.20) 
(l-!'-r22) 

However, by definition 


Pj-1^ 






m 

V 


(4.21) 


where V ii> tha total volume of the system. 

Then, with (4.21) one can define a system coefficient 
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l3 


(4.22) 


This coefficient can be calculated for any initial system configuration 
and remains constant as long as the mass is kept invariant. Then, for 
a given physical system it is possible to find the nondi mens ionali zed 
diameters by using 


c.s. 


<»el 


2 


" lld-krl") + T2(l-kr22) 



(l'kr2^) 


(4.23) 


together with relationship (4.7) 

Another useful parameter to analyze the effect of variations of 
the system geometry is the natural frequency of the corresponding r.lamped- 
free system. For the purpose of comparison, W.J. Book (personal commun- 
ication) based on the nondimensionalization described before and using 
a transfer matrix model, determined those natural frequencies for 
different ratios cf the stiffness El and several payloads. The results 
are shown in Figure 4.7 where 


w = '^clamped 

Wd (4.24) 

and the factor (2/(1 + i/eI 2 /EI] )) corresponds to a correction factor 
which takes into account the definition of vjd based upon EI-|. With 
these elements it is possible to analyze the benavior of a stepped 
beam under the general rigid gains type of control. 




• J 

o 

o 

1 r 

o o 

O 

1— 

Ci 



UO 

TT m 

{^n+i^ )/^z » 

CSi 


o 
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In order to get some Insight Into the effect of ooss section 
voiiatlons. the control nethod was applied to the system described in 
Table 4.3 assualng constant length and constant total rass. Two 
cases were chosen: no payload at all and Itii^d payload mass of the 
sane order of magnitude as the mass of the total am. 

4.7 tk) Payload - fl2 Variations 

In this case the procedure was applied as before for each chosen 
El 2 ratio. The results can be seen in Figure 4.8 for EI 2 varying 
from 0.2 to 0.8. As one can notice, if no payload is present, the arm 
bandwidth becones better as one decreases the EI 2 ratio. However, if 
one uses the results presented in Figure 4.7 It Is expected that the 
best bandwidth for the system would be obtained for EI 2 ratio equal to 
0.045, vdilch corresponds to the naxiimn clamped- free frequency of the 
equivalent system. This has not been verified and is included In the 
suggestions for further work. 

1.8 With Payload-El2 Variations 

■pTB effect of payload seems to be very important in the search for 
thi! best geometry of the system. VAiile an accentuated stepped-beam ap- 
peav*s to be the best design for no payload situation, a uniform system 
looks the best indicated for carrying payloads. This can be seen in 
Figure 4.9 \'here the method of general rigid gains v/as applied in the 
same ^&y as without payload, for the case of mp * 1.0. A close look 
reveals that the system seems to converge for the best bandwidth when 
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-9.0 -8.0 -7.0 -6.0 -5.0 -4.0 -3.0 -2.0 -1.0 0.0 

Re(2W(/un‘2)) 


Figure 4.8 - Root loci of dominant poles - GR6 Control 
stiffness variations payload 
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(D n'j • 0.2 
(D • 0.4 
(D CTg « 0.6 
(§) ir^ • 0.8 



Values of w for each case 

1.0. 2. 0.3. 0.4. 0.5. 0.6.0, 

8.0. 10.0 




•9.0 -8.0 -7.0 -6.0 -5.0 -4 .0 _ -3.0 -2.0 -1.0 0.0 

Re(2j5/(yi^)) 

Figure 4.9 - Root loci of dominant poles - GRG Control 
stiffness variations ~ ^ 1.0 
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EI 2 approaches 1.0» that Is* when the tvra beams have the same di- 
mensions. 

Comparing tiie maxiniri reasonable bandwidth with the results from 
Figure 4.7 it appears that the best results are those for CI 2 =1.0, where 
ttie system bandwidth is about the natural frequency of the equivalent 
clamped free system. Also, as was expected for lumped payload, the 
bandwidtii is considerably lower than in the case of no payload. These 
two sets of results show that the designer should be very careful in 
specifying the system geometry with respect to the kind of work the arm 
has to perform. Also it is very important the analysis of the system based 
upon the payload geometry because of natural frequency reduction caused by 
the increasing rotary inertia. This fact was not considered in the 
present work. 

4 . 9 Simon-ilitter Algorithm Applications 

At the beginning of the present work, the idea was to apply modal 
control in order to place the poles of the system at any desired position. 
However, after a nunber of applications it was verified that the parti- 
cular algorithm (SMA) used for tlie modal control design would not solve 
the problem due to the fact that poles were moved to positions that did 
not correspc to mininuin sensitivity. As a consequency any small varia- 
tion that appeared in the process would shift the poles to ether locations 
and even to undesired unstable situations. Once reasonable results v;ere 
obtained using the general rigid gain method, the idea of applying modal 
control changed to simply trying to improve t!)e system bandwidth obtained 
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from rigid gains. Even in this case, if some improvement was obtained 
it should really be significant in order to compensate for the required 
measurements and/or estimation of the remaining state variables of the 
system. 

Finally, assuming that a good bandwidth was achieved with the (SMI\;, 
the final decision should be made by cott 9 )aring the required torque with 
the ones obtained from the application of the other design procedures. 

In order to present some results from (SMA) applications the 
example of Table 4.3 was used with equal beams. Initially the system 
was assumed witli no feedback at all. In terms of oole locations, all 
poles lay on the imaginary axis v/ith four poles at the origin. As the 
modal control algorithm was not implemented in this work for applications 
to cases with repeated eigenvalues, very small gains were assumed in or- 
der to disturb numerically the polos at origin. The initial configura- 
tion is indicated in Table 4.5 where £] * ^2 ^ 

It was shown before that wJien the general rigia gain method was 
applied to this system, the best control situation was achieved for the 
two dominant poles close to the natural frequencies of the clamped-free 
equivalent system. As this frequency has the value w = 3.52, the first 
movement using the Simon- Mi tter algorithm v/as to shift the two first 
dominant poles of Table 4.5 to the point(-3 t 3j), that is, trying an 
improvement of about 20% with respect to the rigid method. For com- 
parison, the rigid gain procedure was used in an attempt to obtain si- 
milar dominant pole locations. All the eigenvalues arc shown in Table 
4.6. 
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Eigenvalue 

Real Part 

Imaginary Part 

1 

0.0 


2 

0.0 

-^1 

3 

0.0 

^2 

4 

0.0 

-42 

5 

0.0 

44.3 

6 

0.0 

-44.3 

7 

0.0 

68.6 

S 

0.0 

-68.6 

- 

0.0 

151.0 

10 

0.0 

-151.0 

11 

0.0 

161.0 

12 

0.0 

1 

-161.0 


Table 4.5 Initial Configuration for Application of 


Modal Control Algorithm 
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Eigenvalue 

Real Part 

Imaginary Part 1 

1 

-2.8 

2.9 

2 

-2.8 

-2.9 

3 

-1.5 

3.7 

4 

-1.5 

-3.7 

5 

-6.1 

0.0 

6 

-8.4 

53.9 

7 

-8.4 

-53.0 

8 

-15.4 

103.8 

9 

-16.4 

-103.8 

10 

'44.9 

129.0 

11 

-44.9 

-120.0 

12 

-1361.5 

i 

0.0 


Table 4.6 Configuration From General Rigid Gains For 

Comparison With (SMA) 
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One important distinction between the tvra control procedures is 
that in the case of rigid gains the high frequency poles a»'e free to 
move during gains variations (Table 4.6) and in case of (S*1A) all poles 
were specified to remain at the same position (Table 4.G) except the 
ones chosen for relocation. The control is not only acting to move 
a pair of poles but also to keep the other poles at a fixed position. 

This fact is displayed very well in Table 4.7 where the f’ains using both 
methods for obtaining the same dominant eigenvalues (of Table 4.6) ap- 
pear in the same order as in expression (4.13). One notices that for 
the first input to the system the gains corresponding to angular position 
and velocity feedbacks are smaller in case of (SMA) v/hile for the second 
input (SMA) appears with bigoer gains probably because of the soecifica- 
tion of the second do'"inant pole to a better position than rigid gains 
gave. On the other hand, due to the fact that the high frequencv poles 
remain constant, (*^':A) presents reasonably largo linear feedback gains. 
Again this fact requires high accuracy in the measurements or estimation 
that must be made to apply tne Simon-'litter technique because of observed 
liigli sensitivity of the poles v;ith respect to gain variations. 

A second shift using the Sinon-!1itter algorithm was performed moving 
the first dominant poles to (-5 ± 5j). In this case the modal control 
gains increased op to 1*^ tiiries more tiian those presented in Table 4.7. 

Tlie rigid gain method cannot yield both dominant poles near this position, 
so no direct comparison i.> possible. 

Another inporlant effect of the modal coiitrol feedbacks, especially 
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the positive ones, is with respect to system stability. For small mo- 
tions around the equilibrium position used for control design (shoulder 
and elbow joints with zero degrees) the linearized model presented sta- 
ble eigenvalues. However, due to high sensitivity of the poles to para- 
meter variations, the achieved arm bandv/idth is rapidly lost as the joint 
angles change. For gross motion of tfie elbow joint from 0“ to 90* using 
constant gains obtained by the application of 0®, some high fre- 

quency poles change rapidly to the right half complex plane, making the 
system unstable. This fact was one of the bad characteristics of 
application because for different equilibrium position designs, the 
gross motion always presented unstable liigh frequency poles. This fact 
was not observed using constant gains obtained at the same position using 
general rigid gains method. As a result, the Sinon-Mitter algorithm 
could not be applied using constant gains for a given gross motion but 
would only give some improvement for small motions around equilibrium 
position. This implies that the use of (S'-W) for this kind of system 
would bring some reasonable results only if one has a kind of adapti ve 
modal control . Finally, depending upon the tasks to be performed there 
is a possibility of controlling the gross lotion with the rigid gain 
method and the fine motion using modal control techniques, using dif- 
ferent sets of constant gains. 

4.10 System Analysis Using Sensi ti vi ties 

Another procedure to achieve desired pole allocations for the pre- 
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Rigid 

IktOod 

•Vjdal 

Control 



Gal .1 

Rigid 

liethod 

’lodal 

Control 

singular 

’csit^on 


-5.3 

BB 

-l.F 

-4.2 

Feedbacks 


-i.e 1 -1.2 

-L 


■H 


Linear 

•^13 

3.0 j -r.4 

! 

^?3 

I 

0.0 I -io.fi 

Position 

Fee<B>acks 

*=14 

0.0 


k24 

l.n 

V..4 


hs 

3.0 

-S.f 


n 
• • 

-*.P. 


'‘IS 

0,0 

-l.c 

*'2S 

i 

O.-O 

-1.3 

Mgul ar 
Veloci ty 

•‘I? 

-l.s' -1.4 

-O.gI -0.4 

. 

•‘27 ! 

1 

1 

-o.e 1 -1.5 

Feedbacks 

'V: 

•‘2-3 ■ 

-0.2 

/> •“ 

Linear 

^in 

n ^ 

-3.7 


•o.n 

-3.7 

Velocity 

Fec(£>acks 

LllO 

0.0 1 
! 


^210 ! 

0.0 

+3.4 


'‘in 

3.0 

-1.3 

^'211 ; 

O,*' 

-1.7 

1 

hi2j 
1 ! 



*'212 ; 

0.0 

-3.5 


Table 4.7 Conparison of Gains frnr. Morf^ral '’irit? Method and ?lodal Control 
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sented system was the use of eigenvalues sensitivites using the analyti- 
cal expressions described In Chapter III. To understand the procedure 
let one consider the same exauple presented In Tables 4.3 and 4.6 with 
the two pairs of doninant poles described with greater precision In Table 
4.8 


Eigenvalue 

Real Part 

Imaginary Part 

Magnitude 

Damping Ratio 

1 

-2.792 

♦2.957 

4.066 

0.686 

2 

-1.540 

♦3.775 

4.077 

0.377 


Table 4.8 Initial Configuration for Sensitivities Apolication 

Let one assume that only angular feedbacks are available for controlling 
the system. Then, only sensitivities corresponding to eight gains are 
necessary for analyzing the system despite the fact that all poles wist 
be checked for sta.*'il1ty. In order to illustrate the procedure let one 
cosider only the sensitivities of the two poles indicated in Table 4.8. 
The values of the sensitivities are presented in Table 4.Q and they rep- 
resent the real and inaginary part of the rig' t hand side of expression 
(3. JO). 

Let one assuiio tliat a small ir.prove;nerit shoulf! be obtained in both 
poles in tiie sense of shifting then as close as possible to a damping 
ratio of 5 = 3.737 \/hilc keeping about the sa;^ie nagnitude. From Table 
4.3 it is possible to see tnat pole 1 is much nore sensitive to gain 
variations than yolc 2. However, as it would: ’:r more desirable to move 
pole 2 rather than pole 1, il is obvious tiiat one siiould base the cal- 
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6afH 

• 

I 

Sensitivity 


r 




Real ^rt 

laagliiaiy Part 





_ . 

' 



T 







- 


•'ll 


-0.1237S 

-1.6737 


P 


*12 

■ 

-0.25930 

♦3.9537 




kl7 

■ 

♦5.5M1 

♦S.2614 


■ 



-12.2DW1 

-5.2314 


kiS 

L 



-11.7945 

-0.6004C 

* 

k21 

E 

! 




! 

1 

1 

k22 


-13.1S)3 

-19.5332 

! 

t 

t 

i 

^27 


-30.9911 

-34.G29C 

1 

K 

1 





• 

L 

kw 


♦28.8G3S 

♦14.7410 




•^11 


-0.395B4 

-0.17209 






-0.20C09 

-0.059C1 


p 




l.OSTO 

-1.317C 


0 




1 

; 



Me 


0.4494f 

-0.72077 

i 

i 

L 


*^21 


0.53835 

1 . 

1 -3.54CC9 

? 

t 

1 

1 

E 


- 








0.54731 

-n.F.07'12 

1 


n 


•^27 


-0.35000 

_C qogq,- 


C 

I 




0.23700 

-0.33123 

‘ 


Table Sensitivities nf Poles frrKi Table -1.3 
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cttlatims upon sensitivities of pole 2. Froo (3.3^) md 

saall variations of the gains, one can mite 


tXa 

^kj 



(4.25) 


Hhere is the sensitivity of Gie real (inaginanQ part ef pole* 

with respect to variations in the gain k|jj. h\so, if the smitlvt^ 
is positive (negative) ai^ the eig^value is negative (positive) an 
iMproveoent in tiie poles would be obtained by decreasing the correspond 
ding gain and vice versa. If now one turns to Table 4.9 it iS verified 
that the naximat shift of pole two would be obtained fbr snail variations 
in the gain k^ 7 . However, for this sane gain variations, pole 1 has five 
tines nore sensitivi^ which ocans it would undergo a bigger shift. It 
nust be kept in oind that this analysis is true only fbr ss> variations 
of the gains since expression (4.25) holds only fbr linear deviations 
fran ttie dynanic equilibriun point. Let one assune fbr exaqile that it 
was decided to vary gain ki 7 fron its original value of -1.873 to a new 
value -1.9 wlnle the other gains were maintained constant, fts one sees, 
the variation on the gain was about 1.44!!. The new pole location is 
shown in Tables 4.10a and 4.10b. 


wigenvalue 

Real Part 

Imaginary Part 

thgnl tude 

Damping Ratio 

1 

-2.942 

2.733 

4.01G 

9.732 

2 

-1.560 

3.310 

4.120 

9.380 


Table 4.’Ca Uew Poles Using Expression (4.25) for Sensitivities 
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if^divalue 

Reel Part 

Imaginary Part 

nagnltttde 

Dugrlng Ratio 

1 

IL* 

-2.948 

2.840 

4.093 

0.720 

-1.571 

3.804 

4.117 

0.381 


tible 4.10b Neir h)1es Using CbMputer Prograns froa Appendix A. 

\ ■ 


As one sees* the predicted values from Table 4.10a are very close to the 

mi'ters obtained fron the gain rariatlon using tiie model In a digital con- 

« 

peter. The (Hscrepanqr (diserved In the Imaginary part of pole 1 mIgH be 
explained by the fact that the corresponding sensitivity Is not constant 
fir the assumed gain variation. The new location Is better than the one 

t 

.in Table 4.8 but still Is not enough since pole 2 still nas a small damping 
ratio. Further modifications can he obtained by repeating the procedure 
<ith the sensitivities calculated for the positions represented In Table 4.10. 
In applying j sensitivities procedure for soese of the poles. It Is also 
necessary to know what happens with the high frequenqr eigenvalues since 
th'(^ might go unstable for a desired gain variation to shift a specified 
pole. 

This proc€^' re was applied to several cases in order to improve a 
few of the p les. especially the doninant ones. However, fair results 
were Q^.a1ncd only for a large nunber of trials since the gains variations 
uu£ . be relatively small. For this reason no general results fttw sensiti- 
vities are presented for comparison and the procedure is left only for fine 
adjustments in a final phase of the design . A rore systematic procedure 
might i 2 designed for computer inple^ivntation. 

Finally, it should be noticed that sensitivity played a very important 
role in the present vrork in the sense of analyrinn the numerical resu'ts 
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obtained. Eadi tlwe a ql¥en set of gains Mas obtalnM the sensl tty 1 ties 
helofcJ to judge how accurate the gains had to be In o r der to have only 
saall deviation In the poles correspnndlng to truncation error . Also in 
applying the aodal owtrol algoritha. sensitivity of the high frequency 
poles MS alloys analyzed for the purpose of stability because the pole 
sensitivity My increase considei^ly idten the gains are specified to 
keep the pole at constant pos1t1<m. 

4.11 Copparison of Results gith Rigid Cains - -to Cross Joint Feediack 
In order to sheu tiie effect of the cross joing feedbad: sone re- 
sults obtained in the present work were conpared with those obtaimd by 
U.d. Book using indepemtent joint feedback and a transfer natrix nodel if 
tlie pitysical systen. as described in CB2]. The values of the gains were 
obtained froo a rigid design technique Which yielded a desirable relative 
position of the four nost doninant poles. These gains were presented for 
the case of eipial beams in [62] and slightly modified to allow for the 
changes in inertia where the beams are not equal. Ml results are pre- 
sented for the non-dinensionalized case of Table 4.3 with changes in the 
paroaeters payload and cross section of the component beans. In the 
case of equal beans (EI 2 ° l.n) and no oayload Figure 4.10 shows the re- 
sults obtained from no cross joint feedback. Although only one dominant 
pole is shown, one can see tiiat the naxinum arm bandwidth is about 50^ 
of the clamped- free equivalent natural frequency. Variation of the mass 
distribution of the system from equal beans to a stepped configuration 
with no payload shows a slight Increase In th«> ratio of arm ba.idkidth 
to clamped natural frequency as can be seen fror> Figure 4.11 (El 2 * .05) 
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-6.0 -5.0 -4.0 -3. 0 -2.0 -1 

Rf(2j5r(N/l^)) 

Figure 4.11 - Root loci of dominant po;ai - no InterJoInt ftedbacki 
varying u, stlffneia El- • 0*05 
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and the corresponding plot in Figure 4.7. The effect of paiyload results 
in a reduction in this ratio as can be seen in Figure 4.12. These results 
indicate the inpo^^fice of the infomation between the Joints. However, 
as the control has more dynamics the feedback between the Joints nay cause 
system instability in case of failure. (The examples of rigid gains are 
stable even when the cross joint fee<R>ack gains are set to zero Individ* 
ually or together). 

4.12 Tlie iteasurement of Feedback 

One observes from the definition of coordinates in the proposed 
model for the physical system that the angle corresponding to shrjider 
position (e^) can be measured by a simple potentiometer or other type 
readout. However, for the elbow angle the definition of coordinates re- 
quires that not only the rigid angle must be measured but also the slope 
at the end of the first beam. Here, by rigid angle (er) is meant the 
angle between the tangent at the end of the first bean and the tangent 
at the beginning of the second bean tnat also can be measured by a pot- 
entiometer. Measuraient of tlie slope at the end of the first bean is 
more difficult. In order to present some results comparing the feedbacks 
measuring the flexible or rigid angle, a brief transfomation of coordinates 
has to be presented. The rigid angle can be defined as 

Or = 82 - u^^ (4.2F) 

v/i til 


“fe ’‘'IIE *^11 * '\2Z ^12 


M.27) 
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Figure 4.12 - Root loci of first dominant pole - no Interjoint 
feedback -varying m and fixed payload 
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where the signs of the conponents and ^^^e been described 
with respect to the reference franes In Chapter II. Then, In order to 
use the rigid angle In the feedback law from the general rigid method 
one must have 


H ^ pTi Krai pil proi 

[kj2 mJ [®rj [ktD2 

with the relation of coordinates given by 


*^TD3 


»1 



(4.28) 



0i I 10 0 0 

®rj 0 1 



(4.20.1) 


01*] ri 0 0 

_®r ^0 1 


0 




(4.20.2) 


Using relations (4.29.1) and (4.29.2) in the proposed nodel, some results 
vrere obtained in order to analyze the effect of the measured angle in the 
design of the control. In Figure 4.1‘1 one can see the effect of using 
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definition - variations in payload 



122 



Re(2W(/un'2^> 

Figure 4.14 - Root loci of dominant poles - rigid and flexible angle 
definition - no payload - CTg * 0.045 
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the rigid angle in comparison with flexible feedback for the sy.tei of 
Table 4.3 vrith El ratio equal to unity. The grat:«h . ws the results for 
no p^load and for B.3. It Is clear that feeding back information 
about, tiie flexible motion allows the design of a bettr.>r control. Itowever, 
the improvement In tiie am bandwidth may not justify the consioerable com- 
plications of measuring the deflection at the end cf tlic first beam. For 
Che case of stepped like system with EI 2 * 0.045 Figure 4.14 shows es- 
sentially the sane behavior. 

4.13 Summary 

This chapter presented the gsiieral results obtained from the ap- 
plications of the control techniques presented in Cnapter III. A general 
comparison of the results was presented. Some digital computer simula- 
tions aoplying these results are presented in Chapter V. 
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CHAPTER V 

SmUATlOH OF SPECIAL CASES 


5.1 Ceweral Rasults 

TMs chapter presents sene results fron tflgltil slnolatfen of the 
exwples presented In the previous chapter. The results are non-dfaoH 
slnhailzed ns Indie? ed In Table 4.2 md the naln physical characterfs- 
tics were presented In Figures 4.1 ard 4.2. The values of the aweters 
for nondfaenslonaliaatloa are presented la Table S.1 fte* the case of no 
payload and no Joint ness. 


Physical Quantity 

Symbol 

Exaiqile 1 

Exaiple 2 - 

System Coefficient 

mvm 

1.6333 X 10-5 

1.936 X 10-3 

Stiffness Constant 

H 

1.818 X 10^ 

Ibf -ft? 

1.39 X 105 nt-n? 

Total Length 


53.4 ft 

0.91% 

.Average Hass per 
Ibiit Length 

■ 

0.19769 Itam/ft 

3.955 kg/m 

Dimensional Izatlon 
Frequenqr 

wd 

1.072 rd/sec 

224.5 rd/sec 

01 aenslonal 1 zatlon 
Time 

Td 

5.86 sec 

0.028 sec 


Table 5.1 Paraoeiers for Non-Dlinensionallzatlon of the 
Simulated Examples 

The simulations are divided Into torque Impulse responses and para- 
bola tracking performance. T.e flexible o! itudes are the anplltudes of 
each node component, that Is, q^^, qi 2 , q2U q?2- ” '1."t dis- 
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placamt aeins the llneer deviation of the end of second beta with 
respect to the rigid systen Figure 2.1). 

In order to aialyie the behavior of the systen under the (SW.) 

■odal control algortthn. Exanple 2 was chos«Hn far the pfqrsical case of 
zero reference state vaHables. Following the procedure and results pre> 
suited In tiie previous chapters, a control was designed using the gen> 
eral rigid galia netiiod, sped^ng the doninant poles at Wf. of the 
corresponding claped-ffee natural freqwncy (w * n.6 where Is obtalrnx 
from Figure 4.7). Once the control 1»i was obtained ^ eigenvalues cor> 
responding to the closed- 1 o<h> situation were calculated. Then one returned 
to the original uncontrolled system and applied (SKA) to obtain the closed- 
loop system with exactly the sane eigenvalues as those obtained using the 
general rigid uethod. The purpose of this procedure was to covparc the 
response under fMxIal control (S?*A) to the response un^er W’ and to 
study the effect of pole sensitivity under both. The results presented 
In Figures 5.1 and 5.2 correspond to the elbow torque Irpulse response of 
the sane magnitude. As one can see fran Figures S.la and 5.2a modal con- 
trol allows a smaller total angle variation for the elbow but varies the 
shoulder on re. Goth systems settle down at about the sane time. The 
oscillatory behavior of nodal control at the beginning nl^t be caused by 
the large nuoi>er of feedbacks necessary for controlling the systen, es- 
pecially those from the flexible coaponents. From the torque point of 
view the (SMA) presents a more oscillatory behavior as can be seen fron 
Figures 5.2a and 5.2b. 

The maximum torque is biggar in case of modal control, especially 
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DnO 0 .S 1.0 i.s a.o 8.1 a.o a.i 4.0 

Timt T 

Figure 6. Id <• Flexible Amplitudes Response of Exmeple 2 for lii^lso it Elbow 
6R6 Control for w • 0.6 w. 
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Figure S,2a - Angle Response of Example 2 for lirq»u1se at Elbow 
SMA Control for same poles of GRG with u • O.OilL 
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Figura 5.2b - Torqua Ratponia of Exampla 2 for Impulta at Elbow 
SHA Control for swa polas of 6R6 with w • 0,6 wL 
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Figure 5.2c - Torque at Starting Simulation of Figure 5.2b 
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Time T 

Figurt 5. 2d • End Point DIsrUcMwnt of ExoMpIt 2 for Impultt at Elbow 
SMA Control for sane polos of 6R6 with u • d»6wL 
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at the starting point. Finally, the end point displacement and flexible 
amplitudes are about twice as large when modal control Is cpplled, as can 
be seen In Figures 5.1c, 5. Id, 5.2c, 5. 2d. ftere It Is Important to notice 
that the different behavior presented by the system when using modal con- 
trol algorithm with poles equivalent to the general rigid gains application 
can be justified by the fact that ttw; eigenvectors are not the same. That 
is, with the modal control algorithm It Is possible to bring the p^les to 
some desired location but It Is not necessarily true that the eigenvectors 
will be the same. 

Following the previous results an attempt was made to Improve the 
system response by appi>ing nodal control (SMA) to the general rigid gain 
(Figure 5.2) case and move the two dominant poles to a value of W about 
2.5 tines larger than tJie case of Figure 5.2 (w equals 1.5 of the dim- 
ensionless clamped- free natural frequincy). The remaining poles in this 
application \tere not moved. The results for t.he sane imoulse response can 
be seen In Figure 5.3. The angles variations are smaller than the previous 
case (Figure 5.2) v/lth relatively higher oscillation. Hesolte the fact 
that tlie poles were moved to a position .,f ? = 0.707 damping, the sensi- 
tivities arc so high that as soon as the system starts moving the nev; pole 
locations Indicate ? considerable lots in system daToing. The torque 
history presents about the same maximum as tJ>e previous case but acting 
for a longer period of time. The end point displacement and flexible 
amplitudes represent a considerable increase from the previous case as can 
be seen in Figures 5,3c and 5. 3d. 

Another control '.'as then fc»* exannlo 2 using the general 
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Figurt 5.3d - FiMibIt Miplltudt Retpontt of Examplo 2 for Inpulit it Elbow 
SNR Control with dominant poloi at u ■ 1.5 w- 
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rigid gain aethod. Fdr this situation the gains were obtained b> speci- 
fying the donrfnant poles of the rigid systea at 0.9 (w > 0.9wc) of the diaenslon- 
less natural frequency of the c 1 a^>ed-free associated systeii. T?ie re- 
sults are shown In Figure 5.4a which correspond to a response to torque 
Inpulse at the shoulder. The response presents a saooth behavior that Is 
sHrilar to the slaulatlon of a rigid systea. 

ligain for exa^ile 2 soae gross aotlon slaulatlons were perfbmed. 

In all cases the systea was siq>posed to aove the elbow angle froa -IS* 
to -*-15* according to a double parabola specified as reference Input. In 
Figure 5.4 It Is shown the pole variations when the control remains con- 
stant and the elbow angle Is changed fron 9* to i 90*. Since the control 
was designed for 0* elbow angle (the saae as In Figure 5.1 with GR 6 ) the 
ara bandwidth Is decreased for worliing at elbow angle of 90*. 

If one recalls Figures 5.1 It Is seen that the nondlaenslonallzed 
settling tiae Is of the order of = 3.5. The system was simulated 
tracking doii> 1 e parties of joint angle 62 of durations O.STs, 1 . 0 ?$ 
and 2.9 T^ respectively. This set of results can be seen In Figures 5.5, 

5.6 and 5.7 and one could say that the recoHmrnded time to perform the 
motion should be set equal to the settling tine of the system at zero 
angle position. With this In mind all the conclusions were applied to 
the example 2 with 7 * 0.9, that is, maximum bandwidth for the general 
rigid method and settling time from the parabola tracking. The results 
can be seen In Figure 5.8. It Is Important to notice that Figure 5.8d 
represents the flexible components appearing In the system as described 
In equation (2.36), representing an additional torque generated by the 
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Figure 5.4 - Root locus of donlnant poles for variations of 

elboM angle - Exan^le 2 > GRG Control for w • 0.6^^ 
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Figure 5.4b - Torque Reiponse of Example 2 for Impulf* at Stiou1<l*r 
6RG Control for w • 0.9SL 
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Tlfw T 

Figurt 5.4c > End Point Olsplaeomtnt of Examplt 2 for Inpulst at Shouldtr 
GRG Control for w * 0.9 w. 



Timt T 

Figure 5.4d - Flexible Amplitude Reiponte of Example 2 for Impulse at Shoulder 
GR6 Control for <a • 0.9 «L 
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Figure 5.5a - Angle Response of Example 2 Tracking a double-parabola 
GRG Control for u • 0.6 - Tracking Time Interval 1/; 

of Settling Time of Figure 5.1 
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Figure 5.5b - Shoulder Angle Response of Example 2 
Same Conditions of Figure 5.5a 
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Figure 5.5d - End Point Displacement of Example 2 
Same Conditions of Figure 5.5a 


150 



m m 

is i 
^ 5 

« c 


§ g 


o> c 
c 

- r - ^ 

u 

o « 

f 9 W 

u ^ 


CM •— 

o • 
01 13 m 

*a. so 9 } 
E • u 
<0 0 3 

X O 

LU 0 

U » 

■s - 

u o 

01 o 

S'"! 
2. *o P 

01 -M o» 
ac e c 
o 

01 o ^ 

O CD -M 
C « 0 > 

< CD (A 


<0 


lA 


01 

u 


Ok 


ni (M 

• • • 

a Q Q 


a 

a 


o4 fU PI 

• ft 

a a a 

I I I 


(pj) 3lf>UV 



151 



(pu) di6uv udpinoMS 


a 

I 


Tim* T 

Figure 5.6b - Shoulder Angle Response ot Example 2 
Same Conditions of Figure 5.6a 
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Figurt S.6d - End Point DlspUctmtnt of Examplt 2 
Samt Conditions of Figurt 5.6t 
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Figure 5.6e • Flexible AmplltudM of Examplo 2 
Sano Conditions of Figurt S.6a 
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Figurt S.7& • Anglt Rtsponit of ENUtipIt 2 tricking a doubit-paribola 
GR6 Control for w ■ 0.6 - Tricking Tim Intirvil 
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Figure 5.7c - End >o1nt Displacement, of Example 2 
Same Conditions of Figure 5.7a 



sapn^^duiv aiq^xaij paz^euo^suaui^puoN 


Same Conditions of Figure 5.7a 



0.S 


159 



(pj) ai6uv 


Timt T 

Figure S.8a • Angle Response of Example 2 Tracking a double-parabola 
6R6 Control for u • 0.9 li>^ - Tracking Time Interval 
Equal Settling Time of Figure 5. 4a 
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Same Conditions of Figure 5. 8a 
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Figure 5.8c - End Point Displacement of Example k 
Same Conditions of Figure 5. 8a 
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Same Conditions of Figure 5.8a 
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noni Inearl ties which In this simulation amounts to only about 10X of 
the total torque acting In the system. 

Finally, Figures f .9 presents the elbow Impulse response of example 
1 for u > 0.3 Thl!i case Is a more flexible system and this can be 
noticed by tlie oscillatory beiiavlor of the response In Figure 5.9b that 
Indicates the system torques have to act In a vibrating way In order to 
keep decreasing the effect of a hlgiier flexibility. 

5.2 Suwnary 

This chapter presented sor.ie special simulations using results ob- 
tained from the previous diapter. The systans were simulated for the - 
condition of no pj^load because of large computer time necessary tc 
simulate other configurations. The computer programs are presented In 
Appendix A and are capable of s1.nulat1ons for any configurations. 
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at.^?TEH VI 

CONaUSIOMS AHO SUGGESTIONS FOR FURTHER HOP.K 


6.1 Introduction 

In this chapter, the principal results of the analysis In this 
dissertation are suEuariaed. Soae conclusions about the proposed nc^del 
for manipulator arms are presented and the overall results concerning 
control cpplicatlons and discussed. Suggestions for future work are 
given In the final section of this chapter. 

6.2 SuBwery of the Conclusions on the >1ode1 

This study has presented a new rodel of a two-link flexible mani- 
pulator am. The fact that the model introduces the flexible behavior 
with respect to a hypothetical rigid notion is important in studying 
overall task per^rmance. Tlie expeiim.ntal results from an uncontrolled 
situation have shown that the truncation at the second node of each 
flexible componenc is a good approxinacion. The generalized coordinates 
used in this model, regardless of the nu;A>er of nodes chosen, are suitable 
for obtaining the system configuration at any tine t, which would be very 
helpful from a design point of view. 

The fact that the model is presented in a pseudo-standard form 
X = A X + F(x, x,t) + B u sinplifies the linearization procedure that 
can be used for application of linear control theory as well as allowing 
simulations of the controlled nonlinear system. However, if the control 
law requires more than the simple measuring of joing angles, the use 
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of such a aodel need aore sophisticated techniques for aeasurfng 
the flexible coaqionents. 

A more detailed study of the planar notion Is also possible by In- 
troducing conpilmce and danping associated with the actuators, for 
exanple. 

6.3 Control via (ST1A) 

Fron the point of view of controlling a flexible sanipulator the 
basic Idea of the present work was to design a control technique that 
could allow high speed without extrene deviations fron rigid behavior. 
This means that the desired flexible position and velocity during the 
laotlon should be considered as b.:1ng zero. Hith this in mind, this 
work was started considering the possibility of using one ;.art1cu1ar 
nodal control algorithm as a means to assign desired closed-loop eigen- 
values configuration. Ilowever, despite the efforts '' obtain desirable 
results fron this technique, the attempts did not prt . 3 good control 
design because specifying the eigenvalues does not necessarily mean 
that the controlled system has reached a deslrel situation with respect 
to the eigenvectors. This fact, related to th non-uniqueness of control 
law for a multiple-input system, makes the system very sensitive to gains 
variations which essentially eliminates the possibility of using con- 
stant gains for controlling gross motions of manipulators. Even in case 
of obtaining desirable results from the application of (S’*A) in manipu- 
lator control there exists the probl of ;"ecsurcrx?nt ond/or estimation 
of some state variables present ir. the system nodeling. 
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6.4 Control Using General RUId Gains Method 

With aspect to the rigid like control technique, the addition of 
cross joint feedback seens to work very well In controlling the flexible 
systea. The application of this aethod In the present work lpq>roved the 
speed of response by about a factor of two when coaqiared with the control 
without feedback between the joints. In other words, the ana bandildth 
Is Increased up to the value of the corresponding clanped^free natural 
frequency. This procedure also ellol nates the necessity of flexible 
aeasurer)c:;ts and the use of an estlaator. Finally, the aost lapcrtant 
feature of this oethod Is the possibility of v«ork1ng under constant gains 
since the poles are less sensitive than using (STA). 

This aethod was applied to controlling the system under different 
georr^trlc configurations. ..'icn a IjnpeJ payload nass is present, tiie 
results have shown that tlie arm bandwidth with control decreases compared 
to the no-payload case. As tiie payload becomes bigger, the effect of 
Its rotary Inertia becomes more and more Important, 'dith the Increasing 
of the rotary Inertia the associated clamped-free system will have its 
first natural frequency decreased, consequently reducing the arm band- 
width under control design via rigid gains method. 

However, as a wide range of payloads must eventually be considered 
this work did not deal with all possible alternatives with respect to 
payload geometry. 

It has also oeen ;hown in tliis work that decreasing the relative 
ratio jf stiffness EI 2 In case of no-payload Increases the an band- 
width. The existence of an optimum stiffness ratio with respect to the 
clamped-free natural frequency may indicate a limit for improvement In 
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the c1osed>1oop systen perfonpance tfhen this ratio is varied and the 
system carries no payload or if the payload range is small. On the other 
hand, it has been shown that for handling large payloads the best in- 
dicated ratio is of the order of unity. 

6.5 The Use of Pole Sensitivities to Gains Variations 

The use of pole sensitivity analyses has shown that in most cases 
it is a matter of finding a set of convenient nuntiers in order to move 
the poles to some desirable location. The fact chat this process in- 
volves a large amount of trials makes it not very useful for the over- 
all design but only for fine adjustments. 

6.6 General Remarks 

In measuring the state of the systen it has been sho/n that the 
variables included in the proposed model take into account the flexible 
displacement of the end of the first beam. The improvement in the control 
when this measurement is used may not justify the complications and ac- 
curacy of measuring devices. This means that potentiometer and tacho- 
meter measurw«rits ::a.v be enough to achieve the desired results using 
the general rigid gains method. 

With respect to systen stability, the rigid gains method v/ith 
cross joint feedbacks and symmetric matrices Kj and Kjq presented very 
good results since the systen is always stable, iiowever, if some of the 
interjoint feedbacks fail, the results liave slio»/n that the system remains 
stable at least for arm bandwidth of order of the clanped-free natural 
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frequency of the equivalent system. However, despite the loss of de> 
s1r«^1e response a good safety policy would be to cut all cross feed- 
backs In case of failure In one of then. 

In this work a linearized control technique was applied to a sys- 
tem that In some cases may present severe nonlinear effects. This fact 
Is strongly dependent upon the system Itself and this work did not 
analyze all possible cases of gross notion. In the cases where linear 
control was applied the results obtained were satisfactory If one con- 
sldt'^-^ that the control was designed to keep the systan as close as 
possible to rig*d notions. The nonlinear components, as appearing 
In the equations of the proposed model, act Hke additional torques and 
forces to the system during task motions. In the simulations of several 
cases it was observed that the nonlinear torques amounts to about ten 
percent of the total torque. However, in cases where fie nonlinear ef- 
fects are significant this effect lias to be carefully analyzed. 

Finally Table 6.1 sunmarizes the major results obtained in this 
work when coi'.ipared with rigid method cross joint feedback. 

6.7 Suggestions for Furtlier Work 

The work presented in this dissertation suggests several problems 
for futjre investigators: 

1. Compare the results obtained witti tiie proposed model with 
these from a model with on’y one component mode for each beam; 

2. Extend the pressed model to represent spatial notions con- 
sidering also torsional compliances; 
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APPENDIX A 
COMPUTER PROGRAMS 



SUBROUTINE EOSIM 

c**«* mainline for euuations of motion 

FREE-ELBOw MODEL - T»/0 moOES FD» EACH BEAM 

c This subroutine is usec to construct 
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APPENDIX B 

B.l Modal Decomposition Property [S2] 

This property Is better Introduced through an example. Suppose the 
representation (3.4.1) with n==4 and assume poles 1 and 3 have to be 
changed. Then the control law u becomes: 


ii=ai 


(l.B) 


A « 


are r-dimensional 

vectors . 

Then A 

is given 

1 



1 

^1 * ^11 

0 

^13 

4 

0 

'21 

^2 

^23 

0 

^31 

0 

^3 * ^33 

0 

^41 

0 

*43 

1 

r< 


(2.B) 


Jsing properties for interchanging rows and columns of determinants 
(2.B) yields to 


det(sI-A) = det 


S-X^-611 

-^13 

0 

0 

■^31 

^"^ 3"^33 

0 

0 

■^’21 

~^ Z 3 

S-A2 

0 

■'^41 

■'43 

0 

S-A4 


(3.B) 


On the other hand, if A ^1 and ^2 square matrices 
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det 


-11 -12 


- ^2 


det (A^^) • det 


(4.B) 


Using (4.B) into (3.B) one finally has 


det(sL-A) = {s>X2)(s-x^) • det 


S . Xi - 6 ii 



-« 


13 


^■^ 3'®33 


(5.B) 


B.2 Useful Indentity for Inverson of a Complex Matrix with Complex 
Conjugated Columns 
Let 


®11 ■ hl^ ^11 

®21 ■ ^ 21 ^ ^^21 

®31 ■ ^ 31 ^ *^31 

If one finds 


®11 


^11 

-1 

■“11 

“12 

“13 

®21 

'=21 

*^21 

= 

^11 

^12 

^13 

^31 

'=31 

*^31 

1 

Y 

11 

Y 

12 

Y 

13 



_ 


_ 


• 


ail ^ hlJ 
®21 ^ 21 ^ 
®31 ^31^ 


(6.B) 


(7.B) 
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Then 


^ j “12 - ^12 3 

2 2 2 2 



!]i - ?li j “12 - ^12 j 
2 2 2 2 


^11 


^12 


“13 - ^13 j 
2 2 

“13 - ^13 j 
^13 
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APPENDIX C 

NONDI MENS ZONAL I ZED PARAMETERS OF EXAMPLES 1 AND 2 
Procedure for nondimensionallzatlon 

1 - Determine parameters for nondimensionallzatlon described in 

Table 4.1 

2 - Determine ratios and k ^2 using equations (4.5) and (4.6) 

3 - If EI^ f EI 2 determine system coefficient c.s from equation 

(4.22) and find the diameters using , k ^2 ^nd equations 

(4.23) and (4.7.2) 

4 - Equations (4.11) and (4.12) determine the nond i mens ionali zed 

parameters and ^2 

Tables C.l and C.2 present the nondimensionalized 
parameters for Examples 1 and 2. 



Jxxp = 0.0 

0 

• 

II 

\ ' o-o 

^2= 1.0 

= 0.5 

U-| =1.0 

\2 = 0.5 

U 2 = 1 .0 

dg^ = 0.0136 

ifip = 0.0 

dg2 = 0.0136 

II 

0 

0 



Table C.l - Nondimensionalized parameters of Example 1 
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» 0.842 

n 

o 

• 

o 

* 0.850 

o 

• 

o 

N 

» 1.0 

= 0.5 

0*2 = 0.166 

T 2 • 0.5 

= 1.448 

dg^ =0.1039 

^2 ® 0.551 

dg2 “ 0.0656 

II 

o 

• 

o 

Jxxp » 0.0 


Table C.2 - Nondimensionalized parameters for Example 2 
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